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1.0  SURVEY  OF  INS  COMPUTATIONS 

1.1  Introduction 

A survey  of  INS  navigation  confutations  was  initiated  to 
investigate  the  mechanization  equations  used  in  representative 
types  of  aircraft-INS  configurations  either  deployed  or  under 
development  at  this  time. 

The  survey  results  were  used  in  design  of  the  computer 
error  simulation  program,  described  in  Volume  III  of  this  report. 

The  survey  included  INS  with  a local-level  stabilized  plat- 
form, with  a space-stabilized  platform,  and  with  strapdown  con- 
figurations. The  surveyed  INS  used  either  the  local -level  or  the 
space-stabilized  computational  frame  during  the  INS  navigation 
computations.  Table  1-1  contains  a list  of  the  surveyed  INS,  the 
type  of  platform  stabilization,  and  the  type  of  computational 
frame  used  during  the  navigation  computations. 


TABLE  1-1.  List  of  Surveyed  INS 


! 

INS 

TYPE  OP  PLATFORM 
STABILIZATION 

NAVIGATION  COMPUTATIONAL 

FRAME  USED 

KT-73 

Local-lovel  geodetic 

North-pointing  below  70°  latitude 
Wander-azimuth  above  70°  latitude 

LN-15 

Local-level  wander-azimuth 

Local-level  geodetic  wander-azimuth 

H-386 

Local-level  free-azimuth 

Local-level  free-azimuth  geocentric 

Carousel 

Local-level  free-azimuth 
rotating-level  gyros  and 
accelerometers 

Local-level  geodetic  free-azimuth 

GEANS 

Space-stabilized 

Space-stabilized 

SIGN 

III 

Strapdown 

Local-level  geocentric 

SIRU 

Strapdown 

Local-level  geodetic 

1-1 


The  following  computational  characteristics  were 
investigated: 

a.  Commonality  in  navigation  computations  mechanization 
among  various  INS  types. 

b.  Form  of  gravity  models  employed  in  the  navigation 
computations. 

c.  Detailed  form  of  the  navigation  equations  mechaniza- 
tions . 

d.  Commonality  of  coordinate  frames  and  coordinate  trans- 
formations symbology  employed  in  the  navigation 
equations. 

The  survey  results  are  presented  in  sections  1.3  to  1.8 
and  summarized  in  section  1.2.  The  survey  results  were  also 
used  to  generate  sections  2,  3,  5 and  6. 

1.2  Summary  and  Conclusions 

1-2.1  Commonalities  and  Differences  in  Navigation  Computations 

• A comparison  of  the  commonalities  and  differences  in  the 
navigation-computation  format  of  the  surveyed  INS  with  local- 
level  mechanization  appears  in  Table  1-2. 

TABLE  1-2.  Commonalities  and  Differences  in  the  Navigation-Computation  Format 
of  the  Surveyed  INS  with  Local-Level  Mechanization 


COMMONALITIES 

• The  navigation  computations  are  per- 
formed in  a local -level  computational 
frame  with  world-wide  navigation 
capabilies. 

• A first-order  direction-cosine  trans- 
formation matrix  from  the  platform 
frame  to  the  earth-fixed  frame 

is  used  in  position  computations. 

• Barometric  altimeter  data  is  used  to 
bound  the  vertical-channel  computa- 
tions . 


DIFFERENCES 

• The  local-level  computational  frames 
used  in  mechanization  of  the  INS 
navigation  equations  are: 

(1)  LN-15  and  KT-73  (above  70°  lati- 
tude) INS  use  geodetic  wander-azimuth 
computational  frame. 

(2)  KT-73  (below  70°  latitude) INS  uses 
geodetic  north-pointing  computational 
frame . 

(3)  H-386  INS  uses  the  geocentric 
free-azimuth  computational  frame. 

(4)  Carousel  INS  uses  geodetic  free- 
azimuth  computational  frame. 
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TABLE  1-2.  Commonalities  and  Differences  in  the  Navigation-Conputation  Format 
of  the  Surveyed  INS  with  Local-Level  Mechanization  (Continued) 


COMMONALITIES 


DIFFERENCES 


• The  direction-cosine  matrix,  repre- 
senting the  transformation  from  the 
computational  frame  to  the  earth- 
fixed  frame,  used  in  the  KT-73,  LN-15, 
and  Carousel  INS  computations  is  up- 
dated using  the  angular  velocity  of 
the  computational  frame  with  respect 
to  the  earth-fixed  frame.  In  the 
H-386  INS  computations,  the  updated 
direction-cosine  matrix  is  from  the 
computational  frame  to  the  inertial 
frame.  This  matrix  is  updated  using 
the  level-axis  components  of  the 
angular  velocity  of  the  computational 
frame  with  respect  to  the  inertial 
frame.  The  earth’s  angular  velocity 
is  then  used  to  update  the  matrix 
from  the  inertial  frame  to  the  earth- 
fixed  frame. 

• All  nine  elements  of  the  direction- 
cosine  matrix  used  in  the  KT-73,  H-386, 
and  Carousel  INS  computations  are 
updated.  In  the  LN-15  INS  computa- 
tions, only  six  direction-cosine 
matrix  elements  are  updated. 

• Orthonormalization  of  the  direction- 
cosine  matrix  is  used  only  in  the 
H-386  INS  computations. 

• In  the  vertical -channel  navigation 
computations,  the  barometric  altim- 
eter data  is  combined  with  the  in- 
ertial data  as  follows: 

(1)  KT-73  and  LN-15  INS  computations 
use  third-order  damping  loops. 

(2)  Carousel  INS  computations  use 
second-order  damping  loops. 

(3)  H-386  INS  uses  barometric  data 
directly  (no  inertj  al  vertical 
computations  are  mechanized) . 


• The  surveyed  INS  with  a space-stabilized  platform  (GEANS) , 
used  a space-stablilized  computational  frame  in  the  mechaniza- 
tion of  the  navigation  computations.  The  inertially  derived 
data  is  combined  with  the  barometric  altimeter  data  on  the  accel- 
eration and  the  velocity  levels  (second-order  baro-inertial  loop 
in  the  inertial  frame) . 

• The  commonalities  and  differences  in  the  navigation-compu- 
tation format  of  the  surveyed  strapdown  INS  appear  in  Table  1-3. 


TABLE  1-3.  Commonalities  and  Differences  in  the  Navigation-Computation  Format 

of  the  Surveyed  Strapdown  INS 


COMMONALITIES 

• The  navigation  computations  are  per- 
formed in  a local -level  north-pointing 
computational  frame.  The  INS  compu- 
tation mechanization  is  therefore  not 
suitable  for  operation  near  the  earth's 
poles. 

• A quaternion  is  used  to  express  the 
coordinate  transformation  from  the 
body  frame  to  the  computational 
frame . 

• Position  is  computed  from  the  inte- 
gration of  velocity. 


DIFFERENCES 

• The  SIGN  III  INS  uses  the  geocentric 
computational  frame,  while  the  SIRU 
INS  uses  the  geodetic  computational 
frame. 

• The  SIGN  III  INS  uses  barometric  data 
in  the  navigation  computations,  while 
SIRU  INS  uses  constant  altitude  in 
the  navigation  computations. 


1.2.2  Comparison  of  Gravity  Models 

The  gravity  models  used  in  the  INS  navigation  computations 
are  based  on  the  ellipsoidal  gravity  formula  The  formula 

expresses  the  average  geodetic  vertical  component  of  the  earth's 
gravity  at  sea  level  in  the  form  of  a Chebychev  expansion  approx- 
imation. The  gravity  equation  consists  of  a constant  term  and 
terms  proportional  both  to  the  square  and  to  the  fourth  powers 
of  the  sine  of  latitude.  Above  sea  level,  the  gravity  model  con- 
tains an  additional  vertical  component  proportional  to  the  alti- 
tude, and  a level  (north-south)  term  proportional  to  the  product 
of  the  altitude  and  the  sine  of  twice  the  latitude  angle.  The 
magnitude  of  each  of  these  additional  terms  is  less  than  24yg. 


The  gravity  models  used  in  the  KT-73,  LN-15,  and  Carousel 
navigation  computations  consist  of  the  geodetic  vertical  compo- 
nents. The  gravity  model  contains  the  constant  term,  the  term 
proportional  to  the  sine  of  the  latitude  squared,  and  the  term 
proportional  to  the  altitude.  C dssion  of  the  fourth-power  sine 
of  the  latitude  term  results  in  gravity  error  of  less  than 
23pg.  The  KT-73  or  LN-15  gravity  models  use  the  same  values  of 
the  model  terms.  The  Carousel  gravity  model  term  values  are 
slightly  lower  than  the  corresponding  term  values  in  the  KT-73 
or  LN-15  gravity  models.  The  difference  is  due  to  a slightly 
different  value  of  the  earth  parameters  used  in  computing  the 
model  term  values.  The  resultant  difference  between  the  gravity 
magnitude  in  the  KT-73  or  LN-15  and  the  Carousel  computations  is 
less  than  20pg. 

The  gravity  models  used  in  the  H-386  and  SIGN  III  INS 
navigation  computations  consist  of  a geocentric-vertical  and  a 
geocentric-north  component.  The  gravity  components  are  computed 
with  an  accuracy  on  the  order  of  20yg. 

The  gravity  model  used  in  GEANS  navigation  computations 
consists  of  gravity  terms  computed  in  inertial  rectangular  co- 
ordinates. The  gravity  is  computed  with  an  accuracy  of  the 
order  of  O.lyg. 

The  magnitude  of  the  gravity  error  resulting  from  the 
gravity  model  approximations  used  in  KT-73,  LN-15,  H-386,  Carou- 
sel, and  SIGN  III  INS  navigation  computations  is  comparable  with 
the  magnitudes  of  the  gravity  anomalies.  In  addition,  the  ver- 
tical component  of  gravity  error  has  not  significant  effect  on 
the  navigation  errors  in  navigation  computations  supplemented  by 
the  barometric  altimeter  data.  The  horizontal  component  error 
does,  however,  introduce  navigation  errors. 
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1.2.3  Detailed  Form  of  Navigation-Equations  Mechanization 


As  part  of  the  INS  navigation-computation  survey,  a 
detailed  study  of  navigation-equations  implementation  was  inves- 
tigated. 

Three  types  of  INS  configurations  (local-level,  space- 
stabilized,  and  strapdown)  and  two  types  of  computational  frames 
(local-level  and  space-stabilized)  were  included  in  this  inves- 
tigation. The  resultant  six  forms  of  the  navigation-computation 
mechanization  are  represented  by  detailed  flow  diagrams.  In 
addition,  specialized  aspects  of  the  computations  used  in  a 
strapdown  INS  were  investigated  to  determine  the  most  efficient 
mechanization  of  the  strapdown  navigation  equations  in  a local- 
level  computational  frame.  The  details  of  the  navigation  equa- 
tions mechanization  are  presented  in  section  2 of  this  volume. 

1.2.4  Commonality  of  Symbology 

The  survey  of  the  various  INS  navigation  computations 
indicates  a lack  of  standardization  in  symbology  of  frames  and 
transformations.  The  symbology  used  varies  not  only  among  vari- 
ous INS  types,  but  it  is  also  not  always  consistent  in  the  same 
type  of  INS  computations. 

In  the  KT-73  INS  computations,  for  example,  the  local-level 
platform  and  the  computational  frame  use  different  definitions 
of  axes'  orientation.  Also,  the  LN-15  series  INS  do  not  use 
consistent  symbology  of  frame  definitions.  The  survey  results, 
presented  in  section  1,  employ  symbology  used  in  the  surveyed 
reports . 

A proposed  standardized  notation  based  on  the  Honeywell 

(2) 

convention  used  in  SPN/GEANS  is  presented  in  section  6 and 
it  is  used  in  sections  2 and  3 of  this  volume. 
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1 . 3 KT-73  Inertial  Navigation  Coroputations 

1.3.1  General 

The  KT-73  inertial  measurement  unit  (IMU) , manufactured  by 
the  Kearfott  Division  of  Singer,  is  used  in  the  AN/ASN-90 (V) 
inertial  measurement  set  (IMS) . The  IMS  is  a part  of  the 
inertial  navigation  system  (INS)  used  on  the  Air  Force  A-7D 
tactical  fighter  bomber,  the  Air  Force  AC-130E  gunship  and  the 
Navy  A-7E  attack  fighter-bomber. 

The  INS  uses  the  AN/ASN-91(V)  computer  (NWDC) , manufactured 
by  IBM,  to  provide  navigation  and  weapon  delivery  information  to 
other  aircraft  avionic  systems.  The  NWDC  receives  inputs  from 
many  avionic  systems  including  the  AN/APN-90(V)  doppler  radar 
set,  manufactured  by  Kearfott,  and  the  CP-953A/AJQ  air  data  com- 
puter, manufactured  by  Air  Research.  The  NWDC  is  a 16,000-word, 
16-bit,  fixed-point,  magnetic-core-memory  digital  computer. 

The  KT-73  INS  contains  a four-gimbal  platform.  The  plat- 
form employs  the  two-degree-of-f reedom  gyroflex  gyros,  with  one- 
degree-of-freedom  caged.  Torque-restrained,  pendulum- type 
accelerometers  mounted  on  the  platform  are  used  to  measure  the 
specific  force.  The  horizontal  components  of  the  specific  force 
are  measured  by  a two-axis  accelerometer  and  the  vertical  speci- 
fic force  is  measured  by  a single-axis  accelerometer. 

The  platform  stabilization  below  70°  latitude  is  local- 
level,  north-pointing  and  above  70°  latitude  the  stabilization 
becomes  local-level,  wander  azimuth.  The  vertical  channel  com- 
putations are  stabilized  by  the  barometric  altimeter  data.  The 
stabilization  mechanization  employs  a constant-gain,  third-order 
loop.  The  doppler  radar  measured  velocity  is  used  for  damping 
of  Schuler  oscillations  in  the  inertially  derived  velocity. 

The  velocity  damping  mechanization  employs  second-order  constant 
gain  loops. 
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This  section  contains  a description  of  the  navigation  com- 
putations of  the  position,  the  velocity  and  the  attitude  employed 
in  the  pure  inertial  mode  of  operation  (with  no  doppler-radar 

measurements) . The  description  is  based  on  reports  generated  at 

( 3) 

the  Naval  Weapon  Center,  China  Lake,  California  . The  Center 
is  responsible  for  the  maintenance,  validation,  and  modification 
of  the  A- 7 D/E  navigational  and  the  weapons  delivery  equations. 

1.3.2  Coordinate  Frames 

This  section  contains  a definition  of  the  frames  used  dur- 
ing the  navigation  computations  of  the  position,  the  velocity  and 
the  attitude.  The  symbology  of  frames  and  transformations  used 
in  this  section  is  obtained  from  Reference  (3). 

The  frames  used  during  the  navigation  computations  of  the 
position  and  the  velocity  are  the  earth  centered  frame,  xQ,  y , • 
z , the  platform  reference  frame,  x , y , z , and  the  computa- 

t*  ir 

tional  frame,  x,  y,  z,  as  shown  in  Figure  1-1.  The  computational 
frame  coincides  with  the  local  vertical  geodetic  frame  for  lati- 
tude L < 70°.  For  L > 70°  the  computational  frame  becomes  a 
wander  azimuth  frame.  (The  wander  angle  is  equal  to  a.) 

The  platform  frame  axes  are  also  in  a local  geodetic  frame 
north-point  for  L < 70°  latitude,  and  wander-azimuth  for  L > 70°. 
The  platform  axes  do  not  coincide  with  the  corresponding  axes  of 
the  computational  frames.  There  seems  to  be  no  justification  for 
choosing  a different  definition  for  the  platform  and  the  compu- 
tational axes. 

The  aircraft  body  axes,  the  gimbal  axes  and  the  definition 
of  the  attitude  angles  are  shown  in  Figure  1-2. 
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GREENWICH 

MERIDIAN 

xO-Y0'Z0  = EARTH  F,XED  REFERENCE 

X.Y.Z  = LOCAL  GEODETIC,  EAST,  NORTH,  UP 

Xp,Yp,Zp  = PLATFORM  REFERENCE,  NORTH,  EAST,  DOWN 

App  = LATITUDE,  <t> pp  = LONGITUDE,  «=  WANDER  ANGLE 


Figure  1-1.  Definition  of  KT-73  Navigation  Axes  Frames 


1.3.3  Position  and  Velocity  Computations 


• The  KT-73  inertial  navigation  computations  are  performed 
in  a local-vertical,  geodetic  frame,  north-pointing  below 
70°  latitude  and  with  wander-azimuth  above  70°  latitude. 

• The  duration  of  a basic  iterative  cycle  is  40  milliseconds. 

• The  navigation  computations  use  direction  cosine  matrix  C, 
in  mechanization  of  transformation  from  the  computational 
frame  to  the  earth  fixed  frame.  The  matrix  is  updated 
using  a first-order  approximate  solution  of  the  matrix 
equation : 

C = C<{> 

where  <J>  is  the  skew  symmetric  matrix  representing  the 
angular  velocity  of  the  computational  frame  with  respect 
to  the  earth-fixed  frame  expressed  in  the  computational 
frame  coordinates.  The  approximation  is  solved  using 
double-precision  computation. 

• The  vertical  channel  computations  employ  a third-order 
damping  system.  (The  difference  between  the  inertially 
derived  altitude  and  the  barometric  altitude  is  applied 
through  the  proportional  and  the  integral  channels  to  the 
inertially  sensed  acceleration.  The  altitude  difference 
is  also  applied  to  the  inertially  derived  velocity.) 

• The  gravity  computations  employ  the  gravity  model  repre- 
sented by  che  following  equation: 

g = 32.0882  (1  + 5.29  x 10-3  sin2Xpp-10_7hB)  ft/sec2 

where  App  is  the  geodetic  latitude  and  hg  is  the  barometric 
altitude . 


Figure  1-3  presents  a functional  flow  diagram  of  the  KT-73 
INS  computations  of  position  and  velocity  in  the  local  level, 
geodetic,  wander  azimuth  computational  frame.  (For  a north- 
pointing computational  frame  the  wander  angle  a is  zero.)  The 
velocity  increments  AV  sensed  by  the  accelerometers  and  resolve  ! 
along  the  computational  frame  axes  are  combined  with  the  V/R 
terms  and  with  the  Coriolis  correction  terms.  The  computed 
horizontal  velocity  is  resolved  through  the  wander  angle  a,  into 
the  east  and  north  components.  Computation  of  the  vertical 
velocity  component,  Vz,  requires  the  magnitude  of  the  local 
gravity.  In  addition,  the  barometric  altitude,  h0,  is  used  in  a 

O 

third-order  damping  loop  to  bound  the  vertical  channel  instabil- 
ity. The  computed  horizontal  velocity  is  used  in.  the  computa- 
tion of  the  angular  rate,  4> , of  the  computational  frame  with 
respect  to  the  earth-fixed  frame.  The  <j>  is  used  to  update  the 
direction  cosine  matrix  transformation  between  the  computational 
frames  and  the  earth  fixed  frame.  The  updating  is  based  on  solu- 
tion of  the  differential  equation  C = C6.  The  latitude,  X , 

PP 

longitude,  <f>  , and  the  wander  angle,  a,  are  computed  from  the 

Jr  It 

C matrix  terms.  The  components  of  the  angular  rate  <}>  and  the 
matrix  C are  used  in  computation  of  the  gyro  torquing  signals 

V v v 


1.3.4  Attitude  Computations 

The  aircraft  attitude  is  defined  by  the  orientation  of  the 
aircraft  body  axes  shown  in  Figure  1-2,  with  respect  to  a local 
geodetic  axes  shown  in  Figure  1-1.  The  attitude  angles,  roll,  pitch, 
yaw,  are  defined  respectively  by  the  angles  of  rotation  about  the 
x,y,z  aircraft  axes  required  to  bring  the  aircraft  frame  axes 
to  coincide  with  the  corresponding  local  geodetic  frame  axes. 

Figure  1-4  presents  a functional  flow  diagram  of  the  KT-73 
navigation  computation  of  attitude  in  the  local-level,  geodetic, 
wander  azimuth  computational  frame.  The  aircraft  attitude  angles 
are  computed  by  solving  the  following  matrix  equation. 
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Attitude  angles  matrix  = Transformation  matrix  from  the 

aircraft  body  axes  to  the  local 
geodetic  axes 


The  transformation  matrix  from  the  .body  axes  to  the  geodetic 
axes  is  a function  of  the  four  gimbal  angles  and  the  wander  angle  . 
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Figure  1-4 . 


KT-73  Navigation  Computations  of  Attitude 
Functional  Block  Diagram 


1.4  LN-15  Inertial  Navigation  Computations 

1.4.1  General 

The  LN-15  series  INS,  manufactured  by  Litton,  is  used  in 
various  military  and  civilian  aircraft  including  high  performance 
fighter-bomber  aircraft.  The  IMU  contains  a four-gimbal  platform 
series  P-500.  The  platform  employs  two,  two-degree-of-freedom 
gyros,  series  G300G2,  with  one-degree-of-freedom  of  one  gyro 
caged.  Three  torque-restrained,  pendulum-type  accelerometers, 
series  A200D,  mounted  on  the  platform  are  used  to  measure  the 
specific  force.  Most  of  the  LN-15  series  INS  employ  the  LC-72B 
computer . 

Definition  of  the  axes  frame  used  in  the  navigation  compu- 
tations is  not  the  same  for  all  the  LN-15  series  INS.  This  sec- 
tion presents  the  LN-15  navigation  computations  described  in  an 

(4) 

Intermetrics,  Inc.  report  . 


1.4.2  Coordinate  Frames 

(4) 

The  frames  used  during  the  navigation  computations  of 
the  position  and  the  velocity,  shown  in  Figure  1-5,  are  the 
earth  centered  frame,  X,  Y,  Z,  and  the  local  vertical  geodetic 
wander-azimuth  frame,  x,  y,  x.  The  x,  y,  z frame  coincides  with 
the  computational  frame  and  with  the  platform  reference  frame. 

Note  that  the  LN-15  INS  and  the  KT-73  INS  navigation  computations 
use  the  same  definition  of  the  earth  centered  and  computational 
frames. 

Frame  definition  is  dependent  on  the  software  implementa- 
tion. For  the  LN-15S  used  on  B-l  aircraft  the  frames  are  defined 

(5) 

as  follows  by  Boeing  . 

The  earth  centered  frame  has  the  x axis  passing  through  the 
Greenwich  Meridian  and  the  z axis  along  the  earth  axis  of  rota- 
tion. The  x axis  is  positive  through  the  Greenwich  Meridian  and 
the  z axis  is  positive  through  the  North  Pole.  The  platform 
reference  frame,  coincident  with  the  computational  frame  has  the 
z axis  along  the  local  gravity  vector  and  the  angle  between  x 
axis  and  the  North  is  the  wander  angle,  a.  The  positive  direc- 
tion of  the  z axis  is  up  and  the  positive  direction  of  the  x axis 
for  a » 0,  is  North.  The  wander  angle,  a,  is  defined  to  be  posi- 
tive counterclockwise  from  Mcrth. 

1.4.3  Position  and  Velocity  Computations 

• The  LN-15  navigation  computations  are  performed  in  a 
local-vertical,  geodetic,  wander-azimuth  frame. 

• The  duration  of  a basic  iterative  cycle  is  1/16  second. 

• The  navigation  computations  use  a direction  cosine  matrix, 
C,.  representing  the  coordinate  transformation  from  the 
computational  frame,  to  the  earth-fixed  frame.  Only  six 
matrix  terms  (out  of  nine  total)  are  computed. 

• The  vertical  channel  computations  employ  a third-order 
damping  system. 
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• The  gravity  computations  in  the  gravity  model  are  repre- 
sented by  the  following  equation. 

gz  = -32.0881576  (1  + 5.2888  x 10_3sin2L  - 0.955  x 10~7h)  ft/sec2 

where  L is  the  geodetic  latitude  and  h is  the  altitude 

computed  in  the  vertical  channel. 

The  navigation  computations  of  position  and  velocity  are 
represented  by  the  KT-73  flow  diagram  shown  in  Figure  1-3.  Note 
that  the  KT-73  and  the  LN-15  INS  navigation  computations  are 
represented  by  the  same  functional  flow  diagram,  but  the  compu- 
tations employ  different  symbology. 

1.4.4  Attitude  Computations 

The  LN-15  attitude  computations  have  the  same  form  as  the 
KT-73  attitude  computations  described  in  section  1.3.4.  Defini- 
tion of  the  axes  frames  used  in  the  LN-15  attitude  computations 
is,  however,  not  the  same  as  in  the  KT-73  attitude  computations. 

1 . 5 H-386  Inertial  Navigation  Computations 

1.5.1  General 

H-386  is  a designation  for  a member  of  a family  of  Honey- 
well-designed and  built  aircraft  inertial  navigation  systems 
(INS) . Some  applications  are  classified;  others  are  for  aided 
system  demonstrations  including  star  tracker,  satellite  and 
Doppler  aiding.  The  basic  INS  consists  of  the  inertial  measure- 
ing  unit  (IMU) , the  inertial  electronics  unit  (IEU) , the  control 
and  display  unit  (CDU)  and  the  digital  computer. 

A Honeywell  Mark  III  computer  provides  the  navigation  and 
steering  information,  plus  discrete  and  analog  outputs,  to  other 
aircraft  avionics  systems.  The  prime  inputs  from  other  avionics 
systems  are  barometric  altitude,  reference  position  and  Greenwich 
mean  time  (GMT) . The  computer  is  a 24-bit,  fixed-point,  drum 
memory  unit. 
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The  IMU  is  a three-gimbal  platform,  employing  three-single- 
degree-of-freedom,  gas  bearing,  rate-integrating  gyros  (GG159) 
and  three  single  axis,  flexipivot,  hinged  pendulum  accelerometers 
(GG177) . Both  gyros  and  accelerometers  are  pulse-rebalanced 
providing  direct  digital  outputs. 

The  platform  stabilization  is  local-geocentric  vertical, 
free-azimuth.  A north-slaved  azimuth  mode  is  available  for  fixed 
base  testing.  A two  accelerometer  mechanization  is  employed- 
altitude  being  supplied  by  the  barometric  altimeter. 

This  section  describes  the  navigation  computations  of 
position,  velocity  and  wander  angle  in  the  two  accelerometer, 
barometric  altitude,  pure-inertial  mode  based  on  internal  Honey- 
well documentation^' 


1.5.2  Coordinate  Frames 

Several  coordinate  frames  are  employed  in  the  H-386  naviga- 
tion system  mechanization;  these  are  the  platform  coordinates, 
the  geocentric  latitude  and  longitude  frame,  the  geodetic  lati- 
tude and  longitude  frame,  and  an  earth- fixed,  rectangular 
coordinate  frame  with  the  origin  at  the  center  of  the  earth. 

The  platform  coordinate  frame  has  its  origin  at  the  center 

of  the  optical  cube  on  the  azimuth  block.  The  x,  y,  and  z axes 

are  defined  as  the  normals  to  the  theoretical  cube  faces.  This 

coordinate  frame  is  maintained  so  that  the  z axis  is  pointed 

toward  the  geocentric  center  of  the  earth.  The  x axis  is  related 

to  north  by  a rotation  about  z through  the  angle,  \J»  , as  shown 

P 

in  Figure  1-6.  Acceleration  measurement  and  gyro  torquing  are 
done  in  this  coordinate  frame.  INS  velocity  is  also  computed  in 
this  coordinate  frame . 


xyz  frame  by  the  angle,  to. 
coordiate  frame. 


The  geocentric  latitude-longitude  frame  is  related  to  the 

The  INS  position  is  computed  in  this 
The  position  is  then  expressed  in  the  geodetic 
latitude-longitude  frame.  The  geodetic  frame  is  related  to  the 
geocentric  latitude-longitude  frame  by  a rotation  about  the  east/ 
west  axis  of  8^,  as  shown  in  Figure  1-7. 
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Figure  1-7.  Relationship  Between  Geocentric 
and  Geodetic  Latitudes 
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For  computations  of  steering  and  course  selection,  it  is 
convenient  to  express  the  INS  position  in  terms  of  the  direction 
cosines  of  the  vector  from  the  center  of  the  earth  to  present 
position.  In  Figure  1-7,  OP  is  this  vector.  The  coordiante 
frame  in  which  these  direction  cosines  are  expressed  has  its 
origin  at  the  center  of  the  earth,  the  i axis  is  directed  along 
the  earth's  rotational  axis,  the  j axis  lies  in  the  equatorial 
plane  at  longitude  = 0 (the  Greenwich  Meridian)  and  the  k axis 
lies  in  the  equatorial  plane  at  longitude  = E90°.  The  direction 
cosines  of  OP  in  this  frame  are: 

X^  =0  sin 

X-  =0  cos  L,  cos  L 

2 t g 

X.,  =0  cos  L.  sin  L 

3 t g 

where  Lfc  is  the  geocentric  latitude  and  Lg  is  the  longitude. 
Relations  between  the  geodetic  latitude,  L^.  and  the  geocentric 
latitude,  Lfc,  shown  in  Figure  1-7,  are  given  by: 

Lt  = Lt  - KGCSin2Lt 

where 

K„_,  = 3.  367005  x 10  2 rad  = 11.575  arc-minutes 

1.5.3  Position  and  Velocity  Computations 

Two  mechanizations  for  the  velocity  and  position  computa- 
tions have  been  employed  with  this  system. 

In  the  first  (and  earlier)  mechanization  the  platform  is 
stabilized  in  geocentric-vertical,  free-azimuth  frame  (no  torque 
other  than  drift  compensation,  is  applied  to  the  azimuth  axis 
gyro) . The  inertial  angular  velocities  of  the  platform  level 
axes,  “jqx'  ^lOy'  are  res°lvec^  through  the  wander  angle, 
between  the  platform  x axis  and  the  north  direction,  into  the 
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components  along  the  geocentric,  local-vertical,  north-pointing, 
computational  frame.  The  latitude  and  the  longitude  rates  L , 

• t 

Lg  are  then  computed  and  integrated. 

The  problem  of  dividing  the  computed  term  (ft  +,  L^)  003  Lt 
by  cos  L.  is  recognized  by  carrying  1/cos  L and  the  resulting 
(ft  + L ) in  double  precision.  If  computations  determine  that  the 
INS  is  passing  exactly  over  one  of  the  poles  an  overflow  will 


occur. 


The  wander  angle,  is  computed  from 


L + L i 

gn  gn-l 

a)  At  + — ~ — At  sinL. 

e 2 t 


— t..* : 


The  geocentric  latitude,  is  converted  to  geodetic  lati- 


tude, L^,  only  for  display. 


The  second  (and  later)  mechanization  computes  o)10x  and 
the  same  as  the  first  mechanization,  but  then  defines  the  platform- 
to-inertial  reference  frame  transformation  by  a matrix  A consist- 
ing of  elements 

Position  information,  L.  , L , and  ij>  , is  used  in  computation 

. P 

of  A,  which  is  updated  by  integrating  A = Aft,  where  ft  is  the  skew 
symmetrix  matrix  form  of  wIQ,  and  wI0  = u>IOy , 0}.  A first 

order  direction  cosine  update  is  employed  to  form 


An  “ An-1  + An-1 

Direction  cosines  of  the  position  vector  relative  to  the 
center  of  the  earth  are  given  by 


=Z(u)et)  -a23 


l igy  ^-wm^^w^t'--’ 


L , L and  \j>  are  obtained  from  the  appropriate  inverse  trigono- 
t g P 

metric  functions,  viz: 


t = tan_1  (vV  x2 + *T) 

Lg  = tan“1  (vO 


4>p  = tan  I ■ -a12/aUy 


The  geocentric  level  components  of  earth  relative  velocity. 


V£  and  VN,  are 


VE  = R(“lOx  cos*p  - wI0y  sin*p  ‘ we  cosLt 


VN  = R \wI0y  sir%  + wI0y  cos% 


where 

“iOx'  uI0y  are  t^ie  •*-evel  components  of  the  vehicle  angular 

rates  with  respect  to  the  inertial  frame  expressed  in  the  platform 

coordinates.  For  wander  angle,  ifi  =0,  the  x platform  axis  is 

P 

pointing  north  and  the  y platform  axis  is  pointing  east. 

The  "gravity"  model,  geocentric  north  and  radial  components, 
gN  and  gz,  are 


g„  = -0.010489  sinL,  cosL. 

t t 


( ft/sec) 


gz  = 32.199497  (l  + 1.847  x 10"3  sin2Lfc  - 0.262  x 10  7ha 


- 20925738  ( „I0/ + »IOy2 ) 


(ft/sec) 


A functional  flow  diagram  for  the  latter  mechanization  is 
shown  in  Figure  1-8. 

Navigation  computations  are  perform' d in  double  precision, 
fixed  point  arithmetic  (component  compensation  is  single  preci- 
sion) . Attitude  per  se  is  not  extracted  in  the  unaided  naviga- 
tion mode. 

1.6  CAROUSEL-IV  Inertial  Navigation  Computations 
1.6.1  General 

The  Carousel-IV  inertial  navigation  system  INS  is  manufac- 
tured by  the  Delco  Electronics  Division  of  General  Motors,  for 
navigation  and  steering  of  long  range,  commercial  aircraft.  The 
INS  is  comprised  of  the  following  units: 

The  Navigat'  nit  containing  the  inertial  platform  and 
associated  electronics,  the  digital  computer,  the  Control/Display 
Unit,  the  Mode  Selector  Unit  and  the  Backup  Battery  Unit. 

The  computer  provides  navigation  and  steering  information 
during  flight  (plus  calibration  and  alignment  during  preflight) . 

A variety  of  digital  and  analog  inputs  and  outputs  are  available 
depending  on  the  application.  The  computer  is  a serial,  binary 
machine  with  6144-word,  13-bit  core  memory.  Instruction  words 
are  12  bits  plus  parity  bit,  while  data  words  are  24  bits 
including  sign.  Memory  access  time  is  2.6  microseconds. 

The  platform  is  a four  gimbal  unit  with  the  outer  roll 
gimbal  di iven  by  the  inner  roll  resolver  so  as  to  maintain  the 
inner  roll  and  pitch  gimbals  orthogonal.  The  stable  element 
contains  three  single  degree-of-f reedom,  floated,  gas-bearing, 
rate-integrating  gyros  (AC651G) , and  three,  single  axis,  linear, 
force  rebalanced  accelerometers.  The  stable  element  is  sub- 
divided into  upper  and  lower  halves:  the  upper  half  (the  z plat- 
form) contains  the  azimuth  gyro,  the  vertical  accelerometer,  the 
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azimuth  gimbal  synchro  and  torque  motor  and  the  synchronous  motor 
which  drives  the  lower  half  (.the  x-y  platform)  at  a constant  rate 
(1  rpm)  relative  to  the  z platform;  the  lower  half  contains  the 
two  level  gyros  and  accelerometers  and  two  gimbal  resolvers. 


The  vertical  accelerometer  output  is  analog  (with  subse-  f 
quent  A/D  conversion)  while  the  level  accelerometer  outputs  are  J 
digital.  The  azimuth  gyro  is  untorqued  (free-azimuth)  while  the  I 
level  gyros  are  pulse  torqued  via  20  Hz  pulse-width  modulated  1 
loops . | 


A second  order  baro-inertial  vertical  channel  is  employed 
with  an  added  digital  first  order,  low-pass  filter  applied  to 
the  barometric  altimeter  input. 

This  section  describes  the  navi  ation  computations  for 

( 8 ) (9) 

pure  (baro)  inertial  mode  of  operation,  based  on  documentation1 
generated  by  Delco  Electronics  Division  of  General  Motors  (then 
at  Milwaukee,  Wisconsin) . 

1.6.2  Coordinate  Frames 

Four  coordinate  frames  are  used  in  the  mechanization  of 
position,  velocity  and  attitude  computations.  The  inertial 
instrument  axes  (platform  axes)  are  designated  x,  y and  z.  The 
leveling  process  aligns  z along  the  local  gravity  vector,  and 
x and  y rotate  about  the  z axis  at  a rate  u>2  with  respect  to 
inertial  space  (nominally  1 rpm) . The  u,  v,  z frame  is  a free- 
azimuth  local-vertical  frame  used  as  a computational  frame  dur- 
ing the  navigate  mode.  The  MNO  frame  is  an  earth-centered, 
earth-fixed,  right-handed  frame  with  N along  the  earth's  spin 
axis  and  M and  O in  the  equatorial  plane  with  the  0 axis  passina 
through  the  Greenwich  Meridian.  These  coordinates  can  most  easx  y 
be  visualized  by  reference  to  Figure  1-9. 


* 
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1.6.3  Position  and  Velocity  Computations 

The  Carousel  IV  position  and  velocity  computations  are 
performed  in  a free-azimuth,  geodetic  vertical  computational 
frame.  The  computations  are  performed  at  three  iteration 
rates : 

1.  The  minor  or  interrupt  loop  performs  incremental  veloc- 
ity resolutions  and  gyro  torquing.  The  minor  loop  itera- 
tion rate  is  50  mill’ seconds. 

2.  The  intermediate  or  middle  loop  performs  all  horizon- 
tal velocity,  ellipticity,  and  direction  cosine  computa- 
tions in  addition  to  two  autopilot  signals.  The  middle 
iteration  rate  is  200  milliseconds. 

3.  The  remainder  of  the  computation  is  done  in  the  major 
loop  at  an  iteration  rate  of  600  milliseconds. 

At  the  minor  loop  frequency,  20  Hz,  the  level  accelerometer 
AV's  are  transformed  from  the  rotating  x-y  platform  frame  to  the 
free-azimuth  frame  where  they  are  summed  for  four  cycles.  The 
level  gyro  torquing  rate  is  also  updated.  Every  200  milliseconds 
(5  Hz)  the  horizontal  velocity  computations  are  performed  and 
the  incremental  velocity  and  the  computed  velocity  increments 
are  added  to  the  old  velocity.  The  vehicle  rates  are  then  com- 
puted and  the  direction  cosine  matrix  is  updated.  Every  600 
milliseconds  (1  2/3  Hz)  the  position  and  the  "wander"  angle  are 
extracted  from  the  direction  cosine  matrix,  the  vertical  channel 
computations  are  performed,  the  free-azimuth  level  velocities 
are  transformed  to  the  local-vertical  north  frame  and  the  other 
computations  required  for  control  and  display  are  performed. 

The  gravity  computations  employ  the  gravity  model  repre- 
sented by  the  following  equation: 

g = 32.0881  (1  + 5.2648  x 10~3  sin2L  - 0.9558  x 10_7h)  ft/sec2 
z 

where  L is  the  geodetic  latitude  and  h is  the  altitude. 


"Attitude"  computation  of  heading  consists  of  removing  the 
wander  angle  from  the  encoded  gimbal  azimuth  resolver  reading. 
Pitch  and  roll  are  always  available  as  analog  gimbal  resolvers 
outputs  and  are  never  digitized. 

In  summary,  the  "high"  frequency  (minor  loop)  confutations 
are  required  only  because  the  level  (x-y)  platform  is  rotating 
at  1 rpm.  The  x-y  platform  is  rotated  at  this  rate  to  average 
out  many  of  the  level  gyro  and  accelerometer  errors.  The  minor 
loop  computations  could  be  performed  at  the  intermediate  loop 
rate  if  the  free-azimuth  platform  were  not  "carouseled" . 

1 . 7 SPN/GEANS  Inertial  Navigation  Computations 

1.7.1  General 

The  Standard  Precision  Navigator/Gimbaled  Electrically 
Suspended  Gyro  Airborne  Navigation  System  (SPN/GEANS)  is  a direct 
descendant  of  the  GEANS  (AN/ASN-101)  high  precision,  aircraft 
inertial  navigation  system,  both  designed  and  manufactured  by 
Honeywell.  GEANS  consists  of  the  Inertial  Measurement  Unit  (IMU) , 
the  Interface  Electronics  Unit  (IEU) , the  Digital  Computer  Unit 
(DCU  - a Honeywell  HDC-601) , and  the  Control  and  Display  Unit 
(CDU) . For  SPN/GEANS,  the  latter  two  items,  i.e.,  the  DCU  and 
the  appropriate  operator  interface  are  government  furnished 
equipment  (GFE) . The  GEANS  CDU  HDC-601,  is  functionally  an  air- 
borne equivalent  of  the  Honeywell  DDP-516  with  an  8K  memory  (see 
SIRU  description  in  section  1.8).  For  SPN/GEANS,  the  GFE  DCU  is 
manufactured  by  ROLM.  In  either  case  the  prime  interface  between 
the  IMU  and  IEU,  and  the  CDU  and  other  avionics  subsystems  is 
via  a serial  data  bus  (SDB) . 

The  IMU  employs  a four  gimbal,  all  attitude  space-stabilized 
platform.  It  employs  two,  two-degree-of-freedom,  electrically 
suspended  gyros  (ESQ)  with  the  redundant  axis  of  one  ESC  caged 
(by  employment  of  redundant  axis  torquing,  RAT) . Three  single 
axis,  hinged  pendulum,  flexipivot  accelerometers  (GG177)  measure 
specific  force.  Pulse-width  torquing  is  applied  to  the  RAT  axis; 
accelerometer  rebalance  is  via  "bang-bang",  hundred  percent  duty- 
cycle  loops. 
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Vertical  channel  (radial)  damping  computation  employs  a 
constant  gain,  second-order  loop.  Doppler  radar  measurements 
(when  available)  are  applied  via  a Kalman  filter  for  velocity 
damping  and/or  in  air  alignme:  Position  fixes  are  applied  by 


the  same  means. 


This  section  describes  the  navigation  computations  of  posi- 
tion, velocity,  attitude  and  attitude  rate  in  the  pure  baro- 

inertial  mode  of  operation.  The  description  is  based  on  the  SPN/ 

(2) 

GEANS  Cdmputer  Program  Development  Specification  generated  by 
Honeywell  Aerospace,  St.  Petersburg,  Florida. 


1.7.2  Coordinate  Frames 


The  four  primary  coordinate  frames  employed  for  the  navi- 
gation and  attitude  computations  are  the  inertial  reference  frame 
(which  is  the  computational  frame) , the  local  (geodetic)  vertical 
north  frame,  the  body  (or  vehicle)  frame  and  the  platform  space- 
stabilized  frame. 


The  computational  frame  (axes  xQ,  yQ,  zQ)  and  the  local 
vertical  geodetic  frame  (axes  x2,  y2,  z2)  are  shown  in  Figure  1-10. 
An  intermediate  frame  (axes  x^  y-^,  z^)  coincide  with  the  compu- 
tational frame  axes  at  the  start  of  the  inertial  mode  of  opera- 
tion, t = 0.  As  shown  in  Figure  1-10,  L is  the  INS  geodetic 
latitude,  AA  is  the. INS  longitude  change  during  the  flight  and 
(u_  is  the  magnitude  of  the  earth's  angular  velocity  with  respect 

CJ 

to  the  inertial  space. 


The  vehicle  body  frame  (axes  x,.,  y5,  z 5)  is  shown  in  Fig- 
ure 1-11.  The  vehicle  body  axes  coincide  with  the  local  geodetic 
frame  axes  for  a leveled  vehicle  with  the  fuselage  pointing 
north. 


The  platform  reference  axes  have  a fixed  orientation  with 
respect  to  the  computational  frame  axes. 
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1.7.3  Position  and  Velocity  Computations 

The  SPN/GEANS  position  and  velocity  computations  are  per- 
formed in  the  space-stabilized  computational  frame,  as  shown  in 
Figure  1-12.  The  velocity  increments,  AVg , sensed  by  the  accel- 
erometers and  resolved  along  the  computational  frame  axes  are 
combined  with  the  gravity  contributions,  GAt,  and  with  the  baro- 
metric damping  term,  k^Ah.  The  computed  iiierrial  velocity,  Vg, 
is  used  in  computation  of  the  local  geodetic  velocity  components, 
V 2*  The  Vg  is  also  used  with  the  barometric  damping  term,  K^Ah, 
in  the  computation  of  the  inertial  position,  Rg.  The  Rg  is  used 
in  the  gravity  computations,  in  the  geodetic  velocity  computa- 
tions and  in  the  geodetic  position  computations  (latitude,  L, 
longitude,  X,  and  altitude  h) . 

position  and  velocity  computations  are  performed  every  125 
milliseconds  (8  Hz) . 

1.7.4  Attitude  Computations 

The  SPN/GEANS  attitude  computations  are  shown  in  a func 
tional  block  diagram.  Figure  1-13.  THe  attitude  angles  are  com- 
puted by  solving  the  following  matrix  equation: 

Altitude  angles  matrix  - Transformation  matrix  from  the  vehicle 

body  axes  to  the  geodetic  axes 

The  attitude  angles  matrix  is  a function  of  the  vehicle 
yaw,  pitch  and  roll  angles. 

The  transformation  matrix  from  the  vehicle  body  axes  to  the 
geodetic  axes  consists  of  the  transformation  from  the  vehicle  body 
axes  to  the  platform  axes  followed  by  the  transformation  from  the 
platform  axes  to  the  geodetic  axes.  The  former  transformation  is 
determined  from  the  gimbal  angles;  the  latter  from  the  computed 
position  and  time  of  the  inertial  mode  of  operation. 

The  attitude  computations  are  performed  every  31.25  milli- 
seconds (32  Hz)  . 
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Figure  1-13. 


SPN/GEANS  Attitude  Computations  - 
Functional  Block  Diacrram 


1.8  H-429  (SIGN  III)  Inertial  Navigation  Computations 


1.8.1  General 

H-429  is  a designation  for  a member  of  a family  of  Honey- 
well designed  and  built  strapdown  inertial  navigation  systems, 
which  was  used  in  the  SIGN  III  Kalman  Inertial  Doppler  System 
flight  tests  at  Holloman  Air  Force  Base  during  1970  - 1971  period. 

The  INS  uses  the  SIGN  III  computer,  manufactured  by  Honey- 
well to  perform  the  attitude,  navigation  and  Doppler/Inertial/ 
Checkpoint  Kalman  filter  computations  for  the  system  as  well  as 
driving  the  recorders  and  printers  for  in-flight  and  post-flight 
evaluation.  The  primary  external  input  required  for  the  naviga- 
tion function  is  barometric  altitude.  The  computer  is  a 4096- 
word,  20-bit,  fixed-point,  twos  complement,  machine  with  a 2-micro- 
second  cycle  time. 

The  IMU  consists  of  a strapdown  block  containing  three, 
one-degree-of-freedom,  gas  bearing  gyros  (GG334)  and  three 
single  axis,  flexipivot,  hinged  pendulum  accelerometers.  The 
inertial  components,  all  of  Honeywell  manufacture,  are  pulse- 
rebalanced  at  3.6  kHz;  they  have  a high  angular  rate  and  high  g 
capability  compatible  with  high  performance  aircraft  applications. 

The  input  axes  of  the  inertial  sensors  nominally  coincide 
with  the  aircraft  body  axes.  Navigation  computations  are  per- 
formed in  a geocentric  vertical  north  pointing  frame,  hence  the 
system  is  not  suitable  for  use  in  the  immediate  vicinity  of  the 
earth's  poles.  The  barometeric  altimeter  is  incorporated  into  a 
constant  gain,  second  order,  baro-inertial  (geocentric)  vertical 
channel.  Doppler  velocities  and  checkpoint  fixes  are  incorporated 
into  the  system  via  the  Kalman  filter. 

This  section  describing  the  navigation  computations  for  the 
pure  (baro-inertial)  mode,  is  based  on  internal  Honeywell  docu- 
mentation^0^11). 
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1.8.2  Coordinate  Frames 


This  section  describes  the  frames  used  in  the  navigation 
computations  of  position,  velocity,  and  attitude. 

The  frames  used  in  the  above  computations  are  the  body 
(aircraft)  or  platform  frame  and  the  geocentric  local  vertical 
north  pointing  frame.  The  x-axis  of  the  body  frame  is  towards 
the  belly,  the  y-axis  is  towards  the  nose  and  the  z-axis  is 
towards  the  right  wing.  The  geocentric  local  vertical  north 
pointing  frame  has  the  x-axis  towards  the  center  of  the  earth, 
the  y-axis  is  north  in  the  geocentric  level  frame,  and  the  z-axis 
is  east.  This  is  the  computational  frame. 

The  transformation  from  the  body  frame  to  the  computational 
frame  represented  by  the  attitude  matrix,  , is  given  by: 

cb  = x 2 (-0Gc)  Y (_lJ,Gc) 

The  attitude  angles,  6^,  defined  with  respect  to  geo- 

centric frame,  differ  from  those  defined  relative  to  the  geodetic 
vertical  by  up  to  3.3  railliradians  at  45°  latitude. 

1.8.3  Position  and  Velocity  Computations 

• The  H-429  inertial  navigation  computations  are  performed 
in  the  geocentric  local  vertical,  north-pointing  frame. 

• The  basic  navigation  and  attitude  matrix  update  computa- 
tional cycle  is  20  milliseconds  (50  Hz) . 

The  attitude  matrix  update  employs  a second  order  quater- 
nion update  algorithm  using  the  "total  A6"  method,  described  in 
Section  2,  and  conversion  to  the  direction  cosine  matrix  form. 

The  angular  velocities  computed  are  the  inertial  angular 
velocities  of  the  vehicle  in  the  computational  frame  (inertial 
velocities  expressed  in  the  computational  frame) . 
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In  computation  of  the  east  component  of  the  aircraft  veloc- 
ity with  respect  to  the  earth,  the  earth* s inertial  velocity  is 
subtracted  from  the  computed  total  inertial  angular  velocity.  The 
aircraft  north  and  vertical  components  of  velocities  with  respect 
to  the  earth  are  computed  in  the  geocentric  frame  with  no  conver- 
sion to  the  geodetic  frame. 


Latitude  and  longitude  are  obtained  by  integrating  the 
angular  rates.  Latitude  is  converted  to  the  geodetic  frame  for 
display.  The  "gravity"  model  used  contains  the  geocentric  north 
and  vertical  components  of  the  mass  attraction.  The  equations 
are  (10> 

3J2REQ2 


r - m 

D"r2 


'1  + 


(1-3  sin  A); 


2R 


y 3J2  sinA  cosA 

G»'— 7 


where  the  constants,  y and  J 2,  are 

y = 1.407654  x 1016  ft3/sec2 


and 


J2  = 1.0828  x 10 


= 


2.0925738  x 10 


7 


ft 


R is  the  compu^d  present  geocentric  radius  to  vehicle  (ft)  and 
A is  the  computed  present  geocentric  latitude. 

R is  initialized  from 

Ro  = % l1  - esin2  X ( 1 + f ecos2  Xo)  + Ho 


where  o's  as  subscripts  denote  initial  values  and  e = 1/298.3,  and 
Hq  is  the  initial  barometric  altitude.  Thereafter  R is  computed 
from 


KT. 

Sjrti 


Note  that  in  equations  of  R - Rq  = H - H , the  variation  in  R as 

a function  of  latitude  for  a constant  barometric  altitude,  HD, 

is  not  taken  into  account.  As  a result  an  altitude  reference 

2 2 

error  of  the  order  of  eR^  (sin  Aq  - sin  A)  will  occur  at  the 
input  to  the  second-order  vertical  damping  loop. 

1.9  SIRU  Inertial  Navigation  Computations 

1.9.1  General 

SIRU  is  the  acronym  for  the  Strapdown  Inertial  Reference 
Unit,  designed  and  built  by  CSDI,  under  contract  to  NASA/MSC.  It 
is  a redundant  modular  instrument  package  developed  to  achieve 
and  investigate  high  reliability  guidance  and  navigation  concepts. 


For  fixed  based  tests,  the  SIRU  is  interfaced  with  a Honey- 
well DDP-516  digital  computer  with  a 16K  (16,384-word)  core  memory 
plus  two  discs.  For  the  current  flight  test  program,  SIRU  uses  a 
dual,  ruggedized,  Honeywell  DDP-316  installation,  each  with  a 12K 
(12,288-word)  core  memory.  Both  computers  are  16-bit,  fixed  point, 
twos  complement  machines;  the  prime  operational  difference  is  the 
memory  cycle  time  of  0.96  microsecond  for  the  DDP-516  and  1.72 
microseconds  for  the  DDP-316  computers. 


N 
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The  instrument  package  contains  six  single-degree-of-free- 
dom,  floated,  gas  bearing,  rate-integrating  gyros  (size  18,  model 
B,  IRIG)  operating  in  a pulse- torqued  mode,  and  six  single  axis, 
floated-pendulous  accelerometers  (16  PM,  PIPA)  operating  in  a 
9.6  kHz  pulse-on-de:nand,  pulse-rebalance  mode.  The  input  axes 
are  each  normal  to  one  face  of  a regular  dodecahedron,  but  are 
packaged  in  prealigned  modules  permitting  simple  installation  in 
a rectangular  shaped  i"ame. 

From  the  redundant  sensors  an  equivalent  orthogonal  triad 
is  defined  ar.d  used  in  navigation  computations.  A second  order, 
constant  gain,  baro-inertial  vertical  channel  is  employed  with 
the  altitude  set  to  10,000  feet. 

This  section  describes  the  navigation  computations  of  posi- 
tion and  velocity  in  the  pure-inertial  mode.  Attitude  angles 
are  not  extracted.  The  description  is  based  on  reports  generated 
at  CSDL  (12) (13) (14) . 

1.9.2  Coordinate  Frames 

The  coordinate  frames  used  in  position  and  velocity  compu- 
tations in  the  navigation  mode  are  defined  in  this  section. 

The  equivalent  orthogonal  sensor  triad  is  nominally  paral- 
lel to  the  vehicle  or  body  frame.  The  x-axis  is  parallel  to  the 
vehicle  yaw  axis  - positive  up.  The  y-axis  is  parallel  to  the 
vehicle  pitch  axis  - positive  towards  the  right  wing.  The  z-axis 
is  parallel  to  the  vehicle  roll  axis  - positive  forward. 

The  "local-level"  computational  frame  employed  for  the 
navigation  computations  is  geodetic  vertical,  north  pointing. 

The  body  and  computational  frames  coincide  for  a vehicle  geodeti- 
cally  leveled  heading  north.  The  x-axis  of  the  computational 
frame  is  directed  along  the  geodetic,  vertical  - positive  "up". 

The  y-axis  is  tangent  to  the  meridian  positive  north. 

It  should  be  noted  that,  while  the  two  frames  defined  above 
are  the  same  as  the  frames  employed  in  the  H-429  (SIGN  III)  navi- 
gation computations,  described  in  section  1.8,  the  axes  are  re- 
arranged, as  inevitably  seems  to  be  the  case. 
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The  body  to  computational  frame  transformation  in  this 

case  is 

= x(tp)  y(-6)  z(-v>) 


where  the  geodetic  attitude  angles  are,  \p , 0,v> 


1.9.3  Position  and  Velocity  Computations 

Tne  SIRU  inertial  navigation  computations  are  perfomred  in 
a local  geodetic  vertical,  north -pointed  frame.  This  renders  the 
system  unsuitable  for  use  in  the  immediate  vicinity  of  the  earth's 
poles. 


In  SIRU  navigation  computation  the  radii  of  curvature, 
meridional  and  prime  vertical,  rm  and  are  given  by: 


and 

where 


rm  = rQ  { 1 - 2e  cos2L) 

rp  = rQ  (1  + 2e  sin2L) 

2 

r = r (1  - e sin  L) 
o e 


and  r is  the  sea  level  radius  from  the  center  of  the  earth  to  the 
o 

present  position. 


re  is  the  equatorial  sea  level  radius  (6378163  meters) 
e is  the  ellipticity  of  the  meridional  ellipse  (1/297) 
L is  the  geodetic  latitude 


Latitude  and  longitude  rate,  L and  1,  are  given  by 


where  V£  and  VN  are  the  east  and  north  components  of  the  aircraft 
velocity  with  respect  to  the  earth.  The  attitude  matrix, is 
updated  every  20  milliseconds  (50  Hz)  using  the  "total  A9"  method 
and  third  order  quaternion  update  algorithm  and  normalization 
similar  to  that  described  in  section  2.  After  conversion  to 
the  direction  cosine  matrix  form,  the  updated  matrix  is  used  to 
transform  the  AV‘s  accumulated  over  a 20  millisecond  period  to 
the  local  vertical  frame  to  update  the  V.  The  AV  and  A 6 accu- 
mulation times  are  staggered  so  that  the  matrix  values  are  appro- 
priate to  the  midpoint  of  AV  interval. 

The  position  and  velocity  computations  are  performed  at  a 
1 Hz  rate  and  are  earth  relative  (rather  than  inertial  relative 
as  was  the  case  for  SIGN  III)  and  h is  an  externally  supplied 
altitude  (set  to  10,000  feet  for  flight  test).  Since  the  vertical 
channel  does  not  supply  altitude  but  only  altitude  rate,  h,  to  the 
inertial  computations,  the  gravity  model  is  of  lesser  importance 
and  only  a constant  vertical  component  of  gravity  is  used. 

No  attitude  computations  are  performed  in  the  SIRU  mechan- 
ization. 
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SECTION  2 


DETAILED  NAVIGATION  EQUATION  STRUCTURE 

2 . 1 Introduction 

This  section  presents  the  equations  which  are  mechanized  in 
the  navigation  computer  portion  of  the  numerical  simulator  for 
any  of  a local  vertical  wander  azimuth  (LVWA) , a space  stable  (SS) , 
or  a strapdown  (SD)  IMU.  While  computational  flow  diagrams  are 
included  for  both  inertial  (SS)  and  LVWA  computational  frames, 
only  the  LVWA  navigation  '.liorithm  is  developed  in  detail  since 
this  is  the  "selected"  computational  frame  (see  Section  5 of  this 
volume) . Another  area  requiring  some  exposition  is  the  strapdown 
computations,  which,  again,  are  developed  in  detail  only  for 
use  with  a LVWA  computational  frame.  Similarly,  the  attitude 
predictor  filter  is  described  in  some  detail.  The  remainder, 
consisting  mainly  of  transformations,  are  referred  to  and  relegated 
to  the  Appendices. 

2.2  Navigation  and  Attitude  Computations 

2.2.1  General 

The  navigation  and  attitude  computations  for  all  three  INS 
types  and  either  computational  frame  naturally  subdivide  into 
three  gross  modules: 

(1)  Transformation  (T) 

(2)  Navigation  (N) 

(3)  Attitude  (A) 
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2.2.2 


Tranformation  and  AV  Accumulation 


The  function  of  the  first  module,  T,  is  the  generation  of 
the  orthogonal  transformation  from  the  platform  (p)  frame  to  the 
computational  (C)  frame  and  the  subsequent  transformation  of  the 
incremental  velocities  accumulated  over  one  sampling  interval, 
At^,  from  the  platform  frar^  to  *-he  computational  frame.  Reduced 
to  simplest  terms,  it  mechanizes  the  "equations". 

(a)  Generate 

(b)  Av  c = Avp 

IT 

Depending  on  the  nature  of  C^,  the  platform  frame  incremental 
velocities,  Avp,  may  be  transformed  from  the  platform  frame  to 
the  computational  frame  more  often  than  once  per  navigation 
computational  cycle,  AtN«  in  which  case  the  ratio,  AtT/AtN  = 2m, 
where  m=l,2,3,....  An  additional  function  is  defined  in 
this  case,  i.e.,  the  summation  of  the  incremental  velocities 
.n  the  computational  frame. 


r ) 


E 

i=] 


Av' 


For  a LVWA  INS  using  a LVWA  computational  frame,  the  platform  (p) 

c 

frame  and  the  computational  (cj  frame  are  identical,  i.e.,  Cp  = I, 
and  neither  of  steps  (a)  or  (b)  is  required.  If  the  sampling  inter 
val  is  less  than  the  navigation  computational  cycle  it  would  be 

* g 

necessary  to  sum  Av  as  indicated  in  step  (c)  . 
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For  a SD  INS  using  a LVWA  computational  frame,  the 

platform  (p)  frame  is  the  body  (b)  frame.  The  transformation 
. . c 

required  is  C^,  which  is  generated  as  indicated  in  Section 
2,3.3,  the  section  on  strapdown  computations. 

For  a SS  INS  using  a LVWA  computational  frame,  the  plat- 
form frame  is  related  to  the  computational  frame  by  a trans- 
formation which  is  expressed  as  the  product  of  three  rotation 
matrices,  viz: 

C®  = Cc  C®  C1 
P e 1 p 

In  the  present  study,  the  platform  to  inertial  frame  transforma- 
tion, Cp,  is  a constant  since  the  platform  is  considered  to  be 
non-drifting.  is  supplied  by  the  initial  conditions. 

The  transformation  from  the  inertial  (i)  to  the  earth  fixed 
(e)  frame,  C^,  is  a single  axis  rotation,  Z (<^et)  • It  accounts 
for  the  rotation  of  the  earth  from  the  start  of  navigation  until 
the  start  of  the  present  navigation  computation  cycle.  Its  initial 
value  is  I.  The  transformation  from  the  earth  fixed  (e)  frame 
to  the  computational  (c)  frame  is  the  transpose  of  the  "direction 
cosine"  matrix  computed  in  the  LVWA  navigation  algorithm  and  is 
appropriate  for  the  start  of  the  present  navigation  cycle,  but 
uses  the  "gyro  torquing"  signals  to  extrapolate  to  the  middle 
of  the  navigation  computational  cycle . 
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To  minimize  the  computations  required,  the  incremental 

velocii ies  in  the  SS  platform  frame  are  premultiplied  successively 

. i.  G c 

by  each  of  the  three  individual  rotation  matrices,  C^,  C^,  Cg  to 

c 

obtain  Av  . This  operation  requires  three  matrix-by-vector 
multiplications  or  27  multiplies  and  18  adds,  whereas  forming  Cp 
from  three  matrices  and  then  transformating  Avp  requires  . 
multiplies  and  42  adds. 

The  sequence  of  matrix  and  vector  operations  is  indicated 
' in  the  computational  flow  diagrams  for  the  three  INS  types  with 
a LVWA  computational  frame  (Figures  2-1,  2-2,  2-3a,  and  2-3b) . 

The  corresponding  transformation  operations  for  the  three 
INS  types  with  a SS  computational  frame  are  indicated  in  the 
computational  flow  diagrams  (Figures  2-4,  2-5  and  2-6).  In 
increasing  order  of  complexity  of  transformation,  the  systems 
rank  SS,  SD  and  LVWA. 


2.2.3  Navigation 

The  function  of  the  second,  N,  module  is  to  generate  the 
geodetic,  local  vortical,  north-pointing,  velocity  and  position 

c 

components  from  the  incremental  velocity,  Av  , and  the  initial 
conditions.  A non- inertial  altitude  indication,  generally  baro- 
metric altitude, is  also  required.  These  operations  are  embodied 
in  the  Navigation  Algorithm  with  Vertical  Damping  and  the  Output 
Conversion  NAVD/OC.  The  routines  included  in  the  NAVD/OC  are 
tabulated  in  Tables  2-1  and  2-2. 

With  a LVWA  computational  frame,  the  outputs  not  only 

include  the  LVN  position  and  velocity  but  also  the  wander  angle,  a, 

c 

and  the  gyro  torquing  signals, w.  . All  indicated  computations 

1C 

are  performed  for  all  three  INS  types.  The  individual  routines 
are  outlined  in  Table  2-1. 

With  a SS  computational  frame,  the  outputs  are  LVN 

£ 

position,  velocity,  and  inertial- to-LVN  transformation,  (or 
2 

Cq) . The  individual  routines  are  outlined  in  Table  2-4. 

Wander  angle  and  gyro  torquing  signals  are  required  only  for  a 
LVWA  INS.  Special  computations  required  for  the  above  system 
also  contribute  to  the  generation  of  the  transformation  from  the 
(LVWA)  platform  frame  to  the  computational  (inertial  frame)  as 
required  for  the  first  (T)  module. 
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Attitude 


The  function  of  the  third,  A,  module  is  to  generate  the 

attitude  (roll,  pitch,  heading)  angles  of  the  vehicle. 

With  the  LVWA  computational  frame  the  readily  available 

transformation  is  that  from  the  body  frame  to  the  computational 

frame,  C^.  As  indicated  in  Appendix  4.4.7  this  is  not  quite 

£ 

the  attitude  matrix,  C^,  but  differs  from  it  only  to  the  extent 
that  the  heading  "extracted"  from  this  matrix  is  (¥-ct)  . This 
is  shown  in  the  computational  flow  diagrams  Figures  2-1,  2-2, 
and  2-3b. 

With  the  SS  computational  frame,  the  body-to-LVN  trans- 
SL 

formation,  C^,  is  generated  directly  from  gimbal  angles  (as  was 
the  case  with  a LVWA  computational  frame)  and  the  "attitude- 
like" angles  are  extracted  as  before;  "heading"  is  corrected  by 
the  addition  of  the  wander  angle — see  Figure  2-5. 

Attitude  will  be  computed  at  the  same  frequency  as  the 
navigation  computations  or  at  some  binary  multiple  of  the  naviga- 
tion frequency.  In  the  latter  case,  it  may  be  necessary  to 
extrapolate  the  inertial-to-LVN  transformation  or  the  wander  angle. 
Regardless  of  the  computational  frame,  the  three  steps  in  attitude 
computation  and  filtering  are: 

1.  Form  (or  c£) 

2.  Extract  "attitude"  angles  (correct  heading  if  necessary) 

3.  Filter  and  predict  attitude 

The  attitude  filter-predictor  will  be  described  in  Section  2.5.5. 


Table  2-1.  Local  Vertical  Wander  Azimuth  Navigation  Algorithm  with  Vertical 
Damping 

1 Update  platform  frame  velocities. 

2 Add  vertical  damping  terms. 

3 Compute  angular  velocities  about  level  axes. 

4 Update  direction  cosine  matrix  (opt.  2nd  order). 

5 Orthonormalize  direction  cosine  matrix  (1st  order). 

6 Compute  earth's  rate  signals  (angles). 

* 7 Compute  gyro  torquing  signals. 

8 Compute  angular  velocity  [ for  (coxv)  J. 

9 Compute  (coxv)  At  terms  (for  velocity). 

10  Compute  altitude  and  vertical  damping. 

1 1 Compute  gravity  components. 

* 12  Extract  position  and  wander  angle. 

* 13  Form  wander  angle  matrix  and  LVN  velocities. 


•Shown  as  separate  blocks  in  computational  flow  diagrams. 
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"NO  COMPUTATIONS  - INSERTED  TO  EMPHASIZE  FOR  USE  OF  FROM  PREVIOUS 
HIGH  SPEED  COMP.  CYCLE.  fa 

Figure  2-3a.  High  Speed  Computational  SD  System-LVWA  Navigation 

Frame 
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Table  2-2.  Space  Stable  Navigation  Algorithm  with  Vertical  Damping  - Subtracting 
East  Velocity  of  Earth 


Extrapolate  position  to  mid  comp,  cycle. 

Compute  mass  attraction 

Compute  vertical  damping  for  position  computation 

Update  velocity  for  position  computation 

Update  position 

Update  velocity 

Remove  east  velocity  of  earth. 

Compute  inertial  and  reference  radii  difference. 


Transformation  to  Local  Vertical  and  Local  Vertical  (North)  Outputs 
9 Compute  latitude  and  longitude 

10  Form  inertial  to  (geodetic)  local  vertical  transformation 

1 1 Transform  inertial-referenced  velocity  to  local  vertical 


OUTPUTS 


Figure  2-6  . Strapdown  INS  Computational  Flow  Diagram  with  SS  Computational 

Frame 
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Transformation  and  Incremental  Velocity  Accumulation 
Some  further  comments  art  required  on  the  "phasing"  of  the 
incremental  velocities,  AV's  and  the  transformation  to  the  LVWA 
computation  frame  in  the  cases  of  the  SS  and  SD  IMU's. 

2.3.1  Local  Vertical  Wander  Azimuth  IMU 

Ideally,  the  platform  of  the  LVWA  IMU  coincides  with  the 
LVWA  computational  frame.  Hence,  the  AV's  are  merely  summed 
over  a navigation  computation  cycle  and  entered  directly  in  the 
velocity  update  routine  of  the  navigation  algorithm. 

In  practice,  the  IMU  and  computational  frames  do  not  quite 
coincide  with  each  other  nor  with  true  LVWA  frame,  due  to  gyro  tor- 
quing  errors.  Thus,  the  Av's  from  a LVWA  IMU  generally  reflect 
the  effects  of  infinitesimal  rotation  from  their  "true"  values. 

The  mechanization  of  the  gyro  torquing  errors  is  a part  of  the 
LVWA  IMU  simulator  portion  of  the  numerical  simulator. 

2.3.2  Space  Stabilized  IMU 

The  comments  on  the  transformation  of  the  AV's  from  a SS  IMU 
to  the  LVWA  computational  frame  as  described  in  Section  2.2.2 
are  directly  applicable  to  the  simpler,  or  "baseline"  software 
shown  in  the  computational  flow  diagrams. 

However,  when  the  "upgraded"  navigation  algorithm  is  used, 

e o ' 

an  estimate  of  Cc  (or  C21)  at  the  mid-point  of  the  next  navigation 

computation  cycle  is  generated,  which  obviates  the  necessity  of 

"torquing"  C®  (or  its  transpose)  specifically  for  the  purpose 

of  transforming  the  AV's.  The  inertial  to  earth  fixed  transforma- 
0 o 1 

tion,  (C  ) must  then  be  computed  at  the  mid-point  of  the 
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computation  cycle  rather  than  at  the  beginning  as  was  formerly 
the  case.  The  equations  mechanized  are  indicated  below: 


Av 


Av 


•n 

O' 

-n 

2‘ 


-n 


cio  ^10 


C0’  4V° 

°n-l/2  n 


Av:  = (Co, 


n-1/2 


) Av, 


■n 


,0' 

'2 


Co, 


n-1/2 


where  Av  Av  , Av  , Av.,  are  the  incremental  velocities  accumulated 

over  the  nth  computation  cycle  expressed 

in  the  SS  platform,  the  inertial,  earth 

fixed  and  LVWA  frames  respectively. 

is  the  extrapolated  transformation  from 

the  LVWA  to  the  earth  fixed  frame, 

s t 

computed  at  the  end  of  the  (n-1)  com- 
putation cycle  but  extrapolated  to  the 
mid-point  of  the  nth  computational  cycle. 

= Z |(ajie  (n-1/2)  Atn)J  is  the  transformation  from  the 
inertial  to  the  earth  fixed  frame  at 
the  mid-point  of  the  nth  computational 
cycle 

C^0  (or  C^) is  SS  platform-to-inertial  transformation  or  SS 

alignment  matrix. 

In  this  particular  case,  fewer  computations  are  required  for  the 
transformation  of  space  stable  platform  AV's  to  the  LVWA  frame 
than  for  the  basic  "baseline"  algorithm. 


n-1/2 
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2.3.3  Strapdown  IMU 

The  strapdown  navigation  equations  may  be  mechanized  either 
in  the  space-stabilized  computational  frame  or  in  the  local-level 
computational  frame.  The  mechanization  of  the  navigation  equations 
uses  updating  of  the  transformation  from  the  body  frame  to  the 
computational  frame.  The  body  frame  orientation  is  determined 
by  aircraft  attitude  and  high  speed  computations  are  required  to 
update  the  body-to-computational  frame  transformation  in  a 
maneuvering  vehicle. 

For  the  space-stabilized  computational  frame#  the  body-to- 
inertial  frame  transformation  may  be  updated  at  a higher  rate 
than  the  transformation  from  the  inertial  frame  to  the  local 
vertical  north  frame,  required  for  the  navigation  computations. 

For  the  local-level  computational  frame, however,  the  total 
transformation  from  the  body  frame  to  the  local-level  frame  must 
be  updated  at  a high  rate. 

The  transformation  from  the  body  frame  to  the  computational 
frame  may  be  expressed  by  a direction  cosine  matrix  or  by  a 
quaternion.  The  quaternion  representation  of  the  transformation 
is  more  commonly  employed  in  the  present  strapdown  (SD)  inertial 
navigation  systems. 

This  subsection  presents  mechanizations  for  a strapdown 
system  with  a local-lovcl-wandor-azimuth  computational  cramc 
which  update  the  entire  body-to-computational  frame  transformation 
in  the  high  speed  loop. 
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2 . 3 . 3 . 1 Strapdown  Computations  with  Local  Vertical  Wander  Azimuth 
Computational  Frame 

The  (corrected)  gyro  outputs  in  a strapdown  system  represent 
the  integral  of  the  angular  rate  (and  derivatives)  of  .the  sensor 
block  with  respect  to  an  inertial  reference  frame  expressed  in 
sensor  (body)  coordinates  over  the  sampling  interval,  — ib’  If  a 
measure  of  the  integral  of  the  angular  rate  of  the  computational 
frame  with  respect  to  the  inertial  frame  expressed  in  body 
coordinates,  A0^,  is  available,  then  the  difference  between  the 
two  incremental  angles  approximates  the  integral  of  the  angular 
rate  of  the  body  frame  with  respect  to  the  computational  frame  in 
body  frame  coordinates, 

Expressing  the  angular  rates  in  vector  form: 
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Equation  2-1 

.r  the  instantaneous 

angular  velocity  of  the  body 

frame  with  respect  to 

the  compi".  a* 

ional  frame  in  body  coordinate 

The  quaternion  differential  equation  to  be  integrated  is: 

*1  - J&,  (2-2) 


The  corresponding  direction  cosine  matrix  differential  equation  is: 

(2-3) 


* c _ c -fo 

Cb  ~ Cb  ficb 


where  ft  ^ is  the  three  by  three  skew  symmetric  matrix  corresponding 


to  , that  is 
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It  is  necessary  to  integrate  either  Equation  2 -2  or  Equation  2 -3 

. c 

to  update  the  body-to-computational  frame  transformation,  C^, 
which  is  required  to  transform  the  corrected  accelerometer  outputs 

from  the  body  frame  to  the  computational  frame.  Of  course,  the 

c c 

transpose  of  is  also  required  to  transform  from  the  computa- 
tional to  the  body  frame  as  indicated  in  Equation  2-1.  When 
Equation  2-3  is  to  be  used.  Equations  2-1  and  2-4  are  applied 
in  that  order  to  obtain  Equation  C-3. 

In  all  SD  systems  examined  to  date,  oj?c  is  computed,  once 
per  nav  . .ion  cycle,  At^,  from 


c c , c 
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and  it  is  implicitly  assumed  that  u>.  is  zero  over  At  which  is 

—ic  n 

tantamount  to  stating  that 

b 


•b  i c 
u) . = C w . 

—ic  c -ic 


(2-6) 


The  difference  equation  corresponding  to  the  integral  of  Equation 
2-1  over  the  high  speed  computation  cycle,  At^,  is  usually 


expressed  as: 
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where: 


“m  ■ V 

K = 2m,  m is  positive  integer 


At  is  the  navigation  computation  cycle 
n 

1 < N < K 


Vl  = (n"1)Atn 


t 


n 


Vi  + KAtN 


The  only,  computational  difference  between  the  high  speed  loop 
for  a strapdown  system  with  a SS  computational  frame  and  the  same 
system  with  a LVWA  computational  frame  is  the  additional  computa- 
tions given  by  Equation  2-1.  The  additional  computation  adds  9 
multiplications  and  9 additions  per  high  speed  computation  cycle. 
The  computational  flow  diagram  for  a strapdown  (SD)  system  with 
LVWA  navigation  computations  is  shown  in  Figure  2-3.  The  up- 
dating of  directional  cosine  matrix,  shown  in  Figure  2-3,  may 
be  replaced  by  quaternion  updating.  The  quaternion  and  direction 
cosine  matrix  updates  are  discussed  in  section  2. 3. 3. 2. 
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2. 3. 3. 2 Direction  Cosine  and  Quaternion  Update  Algorithm 

The  equations  used  in  generating  the  update  algorithms  are 
extracted  from  Reference  '(16),  Chapter  III.  The  update  algorithms 
are  approximations  to  integrals  of  Equations  2-2  or  2 -3.  If 
Equation  2-2  is  integrated,  the  rotation  quaternion  must  be  con- 
verted to  a rotation  me.  _ix  at  least  for  extraction  of  attitude 
angles,  an  operation  requiring  at  least  9 multiplications  and 
12  additions.  In  either  case  the  quaternion  (or  matrix)  must 
be  periodically  normalized  (or  orthonormalized)  to  ensure  that 
a rotation  is  truly  represented.  A first  order  algorithm  is 
invariably  employed  for  this  purpose.  A quaternion  normaliza- 
tion requires  8 multiplications  and  4 or  5 additions,  while  a 
matrix  orthonormalization  requires  54  multiplications  and  42 
additions  plus,  in  either  case,  a number  of  loads,  stores,  shifts, 
etc.  This  latter  operation  constitutes  one  of  the  chief  attrac- 
tions of  the  quaternion  update. 


2. 3. 3. 2.1  Direction  Cosine  Updatinc 


For  the  case  of  the  rotation  (direction  cosine) , matrix 
update  of  order  i = 1,  2,  3,  the  updated  matrix  is  C^ft  + At) 


where 
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In  the  foregoing,  0.,  where  j = x,  y,  z,  was  used,  instead  of  the 
b 1 b 

components  of  _A0cb  (or  AO^)  simply  for  economy  of  notation. 

Qj  is  0^  from  the  previous  high  speed  computation  cycle. 
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It  is  noted  from  Equations  2-9  and  2 -11  that  the  off-diagonal 
elements  of  the  first  and  third  order  update  matrix  form  a skew 
symmetric  matrix;  hence,  there  are  only  three  distinct  elements 
to  compute.  The  second  order  update  matrix  is  symmetric  and 
involves  six  distinct  elements.  Thus  a subroutine  may  easily 
be  constructed  to  perform  a first,  second,  or  third  order  update 
depending  only  on  the  value  of  a control  parameter,  IC,  where 
IC  - IOU-2,  and  IOU  is  the  integer  order  of  the  update.  The  flow 
chart  of  directional  cosine  updating  is  shown  in  Figure  2-21  . 

The  computations  for  a third  order  update  are  divided  into 
four  boxes  10,  20,  30,  and  40  in  the  flow  chart.  Figure  2-1.  For 
a second  order  update  only  the  computations  in  boxes  10 , 30  and 
40  are  performed.  For  a first  order  update  only  box  30  is 
required.  Following  the  indicated  operations,  the  body-to-compu- 
tational  frame  rotation  matrix  is  updated  (and  periodically  ortho- 
normalized)  . Then  the  AV’s  are  transformed  and  summed  over  At  . 
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BOX  10 


FORM  SECOND  ORDER  TERMS  AND  SECOND  ORDER 

PORTION  OF  UPDATE 

DTXS  <=*  (DTHX*DTHX)/2 

DTYS  <=  (DTHY*DTHY)/2 

DTZS  <=(DTHZ*DTHZ)/2 

DTXY  <=(DTHX*DTHY)/2 

DTYZ  <=  (DTHY#DTH2)/2 

DTZX  <=(DTHZ*DTHX)/2 


•DTYS-DTZS  DTXY 
DTXY  -DTZS-DTXS 
DTZX  DTYZ 


DTZX 

DTYZ 

-DTXS  -DTYS 


BOX  20 


FORM  THIRD  ORDER  TERMS  AND  ELEMENTS  OF  FIRST  PLUS 
THIRD  ORDER  UPDATE 
XDTX<=(DTHZ*ODTY-DTHY«ODTZ)*(1/12l 
XDTY<=(DTHX*ODTZ-DTHZ*ODTX)*(1/12) 

XDTZ  <=(DTHY*ODTX— DTHX*ODTY)*(1/12) 


Figure  2-la.  Updating  of  Body-to-Computation  Frame  Direction 
Cosines  Matrix 


sn 
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BOX  20 
(CONTINUED) 


BOX  30 


BOX  40 


ODTX«=DTHX 
ODTY  <=DTHY 
ODTZ<=DTHZ 

SCL1  <=1.  - (DTXS+DTYS+DTZS)*(1/3) 

DTHX  <=SCL1*DTHX+DTX 
DTHY  <=SCL1  *DTHY+XDTY 
nTHZ  <=SCL1*DTHZ+XDTZ 


FORM  FIRST  PLUS  THIRD  ORDER  PORTION  OF  UPDATE 
(R5.5N]  <=  r 1.  -DTHZ  DTHY~ 

DTHZ  1.  -DTHX 
-DTHY  DTHX  1. 


ADD  FIRST  PLUS  THIRD  ORDER  PORTION  TO  SECOND  ORDER 
PORTION 

[R5.5N]  *=  (R5.5N]  + [DA2] 


Figure  2-7b.  Direction  Cosine  Matrix  Updating  (Continued) 
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2. 3. 3. 2. 2 Quarternion  Updating 

The  steps  involved  in  generating  an  updated  rotation  matrix 
relating  the  computational  frame  to  the  body  frame,  given  the 

U 

t are  now  presented  using  quaternions.  As  before  first, 
second,  and  third  order  updates  are  considered.  In  the  present 
case  the  updated  quaternion  is  q^  (trAt)  where 
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quaternions  where: 


9 = Pg  + p- 


and 


i a,  r 

9 = ^i  + P2j  + P2k 


and  i,  j,  k are  the  frame  vectors  (unit  magnitude,  mutually 
orthogonal,  right  handed)  (in  the  particular  case  i,  j,  k are 
along  the  x,  y,  z axes  of  the  body  frame) . 

A good  concise  summary  of  the  elements  of  quaternion  algebra  is 
presented  in  Section  2.2.1  of  Reference  16 . The  product  of  two 
quaternions,  p and  q,  may  be  written  as 


qp  = q0p0  - £•£  + q0E  + £P0  + axE 
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The  preceding  vector-scalar  form  may  be  handy  analytically  but 
the  most,  efficient  form  for  mechanization  in  a digital  computer 
is  as  the  product  of  a 4 x 4 matrix  by  a 4 x 1 vector,  i.e.. 


(2-16) 


The  purist  may  object  that  Equation  2-16  is  an  expression  for 
the  elements  of  the  quaternion  product  -rather  than  the  product 
per  se  which,  of  course,  ‘is  correct.  To  be  rigorous  then  the  left 
hand  side  of  Equation  2-16  should  be  expressed  as 

r “1 T 

^(qp)0  (qp)1  (<3P)2  (<3P>3J 

The  rearranged  product  pq  is  given  below: 

pq  = p0q0  - e • a + p02  + R^o  + £xa  (2_17) 


The  first  and  third  order  updates  affect  the  elements  , p0,  and 
Pg»  while  the-  second  order  update  portion  affects  nly  the  element 
pQ.  Aid  orders  of  quaternion  updates  work  with  half  the  angle 
rotation,  hence  the  first  operation  is  to  divide  che  elements  of 
the  corrected  19°  by  two  (right  shift)  and  work  thereafter  with 
Acb/2. 
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For  the  third  order  update,  p£  , p2 
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Note  that  the  subscripts  1,  2,  3 aro  equivalent,  to  subscripts 
x,  y,  z,  used  in  the  direction  cosine  update. 


■i 

A similar  logical  flow  may  be  employed  for  the  elements  of 
the  update  quaternion  as  was  used  in  the  direction  cosine  update. 
The  initial  step,  as  noted  previously,  is  division  of  the  A6** 
by  two.  Following  generation  of  the  pj^  , the  4x4  matrix  is 
formed  and  tho  quaternion  multiplication  is  performed  (4x4)  x 
(4  x 1)  with  subsequent  normalization  (perhaps  at  lower  frequency) 
and  conversion  of  the  updated  quaternion  to  a direction  cosine 
matrix. 
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The  ensuing  Av  transformation  and  summation  and  attitude 
extraction  are,  of  course,  independent  of  the  method  used  to  con- 
struct the  direction  cosine  matrix. 

The  flow  chart  shown  in  Figure  2-8  presents  the  computa- 
tions starting  with  AQ_b  and  ending  with  the  updated  (or  c^). 
The  details  of  computations  are  shown  in  Figures  2-8a,  b and  c. 


BOX  100  - SCALE  A0j's  AND  SET  Pq  = 1 

DTHX  <=DTHX/2 
DTHY<=DTHY/2 
DTHZ  <=  DTHZ/2 

P0<=1. 


BOX  110  - FORM 


BOX  120 


AND  po  FOR  SECOND  ORDER 


TS02  <=(DTHX*DTHX+DTHY*DTHY+DTHZ#DTHZ)/2 
PO  «=1.  — TS02 


FORM  3RD  ORDER  TERMS,  SAVE  AOj's. 
XDTX  ^ (DTHZ*ODTY— DTHY*ODTZ)* (1/6) 
XDTV  ■=(DTHX*ODTZ-DTHZ*ODTX)*(1/6) 
Xr/TZ<=(DTHY»ODTX-DTHX*ODTY)*{1/6) 
CON  <®1.  — TS02*(1/3! 

P1<=C0N'DTHX  + XDTX 
P2«=CON*DTHY  + DTY 
P3*=C0N*DTH7  <DTZ 


m 


Figure  2-8a. 


Updating  of  Body-to-Computational  Frame,  Direction 
Cosine  Matrix,  Using  Quaternion  Transformation 
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BOX  120  - ODTX^DTHX 

ODTY  <=DTHY 
ODTZ^DTHZ 


BOX  130  - FORM  1ST  OR  2ND  ORDER  PVP2,P3 

PI  <=DTHX 
P2  <=DTHY 
P3<=DTHZ 


BOX  140  - FORM  UPDATE  MATRIX  AND  MULTIPLY 


(UPDQ]  A 

P0 

-PI 

-P2  -P3 

PI 

PO 

P3  -P2 

P2 

-P3 

PO 

PI 

P3 

P2 

-PI 

PO 

QO 

<=[UPDQ]# 

QO 

Q1 

Q1 

02 

02 

_Q3_ 

_Q3_ 

Figure  2-8b.  Computation  for  Updated  D.C.M.  (continued) 
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BOX  150  - NORMALIZE  UPDATED  QUATERNION 


"qo" 

^COR* 

■qo" 

Q1 

Q1 

Q2 

Q2 

Q3 

Q3 

BOX  160  - CONVERT  QUATERNION  INTO  DC  MATRIX  (Cij) 

Q1S«=Q1*Q1 
Q2S  <=Q2»Q2 
Q3S  <=Q3*Q3 
Q01  <=Q0*Q1 
Q02<=Q0*Q2 
Q03<=Q0*Q3 
Q12<=Q1*Q2 
023  <=Q2*Q3 
Q31  *=Q3*Q1 

C11  <=1.  — 2*{Q2S+Q3Si 
C12  <=2*(Q12— Q03) 

C13  <=2*(Q31+Q02) 

C21  <=2*(Q12+Q03) 

C22  <=1.  - 2*(Q3S+Q1S) 

C23  <=2*(Q23— Q01) 

C31  <=2*(Q31-Q02) 

C32  <=2*(Q23+Q01) 

C33<=1.-2*(Q1S+Q2S) 


Figure  2-8c.  Computation  for  Updated  D.C.M.  (continued) 
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2. 3. 3. 3 Av  Transformation  for  SDIMU 


For  the  SD  systems  considered  both  the  incremental  angles, 

— ib'  an<^  t^'e  increinental  velocities,  AvT  are  accumulated  over 

the  same  interval,  AtN-  This  is  compatible  with  the  output  format 

of  the  profile  generator  progrc  . Some  SD  systems  alternate  the 

outputs  of  A9?k  and  Av  at  intervals  of  At^y^.  While  the  updated 

is  appropriate  for  attitude  computation^,  it  is  one  half  a 

high  speed  computation  cycle  (At  /)  ahead  of  the  transformation 

b N/2  0 

required  for  the  Av  . An  interpolated  value  for  is  required 

for  Ayk  transformation.  When  a direction  matrix  update  is  used, 
it  would  feasible  to  employ  techniques  analogous  to  those  des- 
cribed in  section  2.4.4  for  extrapolating  the  direction  losine 
matrix  in  the  navigation  algorithm.  However,  when  a quaternion 
update  is  used,  there  is  nothing  corresponding  to  the  "update" 
matrix  which  is  added  to  the  "old"  direction  cosine  matrix  to 
obtain  the  "new"  direction  cosine  matrix  (dcm) . 

The  simple  expedient  employed  in  both  cases  was  simply  to 

store  the  "old"  dcm,  Cp  , before  generating  the  "new"  dcm,  c5"  , 

D dn 

N-l  N 

and  then  after  the  update  use  the  ,-erage  matrix  as 


for  the  Av  transformation, 
i.e. , 

cP 

N-l/2 


N-l/2 


2 + ‘O 

2 V N-l  N/ 


(2-21) 


While  the  above  equation  produces  errors  which  are  second  order 
in  A0,  (see  Appendix  E) , they  are  not  cumul  Lve  in  their  effect 
on  c£  . 

Finally,  the  transformed  Av3  is  given  by 


_,c  * b 

1 Av„ 

bN-l/2  ~N 


(2-?2) 


In  the  foregoing  all  the  subscripts,  N,  N-l/2,  N-l,  refer  to  the 
high  speed  strapdown  computation  cycle. 
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2 . 4 Navigation  Equations 

2.4.1  Navigation  Equations  in  Local  Vertical  Frame 

The  fundamental  equation  of  inertial  navigation  for  a 
navigator  employing  an  earth  relative  computational  frame 
(c-space)  is  given  by 


v - £ + a - + zarjv 


ec 


c . c 
ie  — 


(2-23) 


where  v 


v 


c 

2 


ec 


ftC 

le 


is  the  earth  relative  velocity  in  the  computational 
frame 

is  the  time  rate  of  change  of  vc 

is  the  specific  force  (the  portion  of  inertial  accelera- 
tion sensed  by  the  accelerometers)  expressed  in  compu- 
tational frame  coordinates 

A GC-ft?  ft?  rc,  is  the  resultant  of  mass  attraction, 

G , and  centripetal  force,  -ft?  ft?  r , expressed  in 
computational  frame  coordinates 

is  the  earth  fixed  frame  which  is  rotating  at  a constant 
angular  rate,  u>ie,  with  . 'ect  to  the  inertial  frame 
is  the  earth -centered  ine  ^ial  frame  which  is  regarded 
as  non  rotating  with  re.  to  the  "fixed"  stars 

is  the  skew-symmetric  fon.  of  the  angular  velocity 
of  the  computational  frame  with  respect  to  the  earth 
fixed  frame,  expressed  in  putational  frame  coordinates, 


is  the  skew-symmetric  form  of  the  angular  velocity  of 
the  earth-fixed  frame  with  respect  to  the  inertial 

Q 

frame,  expressed  in  computational  frame  coordinates,  to.. 

0 

The  magnitude  of  to.  , w.  , is  a constant  but  the  com- 
ponents  var^  as  a function  of  latitude  (and  wander 
angle) . 


The  function  of  the  navigation  computer  may  be  considered 

tc  be  the  integration  of  equation  (2-23),  to  obtain  the  earth 
. . c 

relative  velocity,  v , followed  by  a second  integration  to  obtain 
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I 


the  earth  relative  position.  Sj.nce  the  earth  relative  position 

is  expressed  mainly  in  angular  coordinates,  latitude,  longitude/ 

(and  wander  angle), it  is  necessary  to  convert  the  level  components 

of  linear  velocity  from  the  first  integration  into  angular 

velocity  form  by  dividing  by  the  appropriate  variable r radii  of 

curvature  to  obtain  (oc  which  is  then  converted  to  the  skew  sym- 

— ec 

metric  form,  c . The  differential  equation  which  is  integrated 
to  obtain  the  angular  position  is 


^ P C 

c-  = ce  sr 

c c ec 


(2-24 J 


The  actual  latitude,  longitude  (and  wander  angle)  are  extracted 
from  Cc  via  the  appropriate  inverse  trigonometric  functions. 

The  remaining  position  variable,  altitude  is  obtained  hy 
integrating  the  vertical  component  of  v . An  external  alti  ude 
reference  is  required  to  eliminate  the  inherent  instability  of  any 
pure  inertial  vertical  channel.  Thus,  the  minimum  number  of 
scalar  integrations  required  to  mechanize  a local  vertical  wander 
azimuth  navigator  is  thirteen  (13).  However,  only  five  of  the 
nine  (9)  elements  of  Ce  are  employed  directly  in  the  navigation 
computations  so  frequently  only  six  of  the  nine  elements  are 
computed . 


2. 4. 1.1  Methods  of  Presentation 

There  are  a number  of  ways  of  presenting  the  equations  which 

are  to  be  mechanized  in  a navigation  computer. 

(a)  The  highest  level  presents  the  exact  differential  equations 
(and  other  equations  or  functions  for  angular  velocity, 
gravity,  etc.).  At  this  level,  there  is  no  order  to  the 
equations  since  all  the  values  of  the  variables  and  their 
derivatives  are  instantaneous.  The  same  information  may  be 
expressed  in  state  space  (matrix-vector)  form  or  in  analog 
block  diagram  form. 

(b)  A second  level  is  the  difference  equation  form,  which  is 
probably  the  mosc  informative  quasi-analytical  method.  Here, 

+ o.-  the  order  in  which  the  equations  appear  is  irrelevant 

s.  ■ '<}  all  the  variables  are  tagged  with  the  (discrete)  times 
when  they  were  computed.  From  the  difference  equations, 
detailed  computational  flow  diagrams  may  be  constructed  which 
convey  the  same  information  in  a more  graphic  form.  This 
latter  form  implies  a particular  sequence  or  order  to  the 
computations. 

(c)  A third  level  is  the  functional  flow  chart  which  generally 
contains  a verbal  description  of  an  unalterable  sequence  of 
arithmetic  operations  on  a number  of  variables  and  constants 
within  a single  "box" . Logic  and/or  decisions  maybe  incor- 
porated via  standard  flowchart  symbols.  The  order  of  the 
computations  appears  explicitly.  The  individual  "boxes" 
may  be  inline  coding,  subroutines  or  functions. 

(d)  A fourth  level  is  the  detailed  flowchart  which  may  be  manually 
drawn  or  from  AUTOFLOW  or  similar  program. 

(e)  A fifth  level  is  the  program  listing  in  a higher  order 
language  (FORTRAN  in  this  case) . The  use*  ilness  of  the 
listing  is  strongly  dependent  on  the  definition  of  the  mnemonics 
and  the  information  provided  by  the  comments. 

(f)  The  sixth  (or  lowest)  level  is  the  assembly  language  listing. 

In  the  present  study  this  is  of  immediate  interest  only  in 
the  case  of  the  precision  reduction  routine,  where  the 
routine  was  actually  written  in  assembly  language. 
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Generally,  presentation  at  the  third  or  lower  level  is 
incorporated  in  Volume  III;  the  first  and  second  levels  are 
included  in  this  volume.  Derivations  leading  to  the  first  or 
second  levels  are  relegated  to  Appendices  b,  El,  and  E of 
Volume  II. 


m 


m 

|J 

pi 
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3§I 


m 


1 


2 . 4 . 1 . 2 Exact  Equations 

The  equations  to  be  integrated  and  the  intervening  computa- 
tions, in  exact  form,  are  presented  below  for  the  undamped 
vertical  case. 

(1)  Derivative  of  velocity 


vC  = fC  + gC  ~(QC  + 2 fi?  )vc 
- - - ec  le  — 


(2-25) 


(2)  Level  Components  of  Angular  Velocity 


= Cl  vc 
— c — 


(2-26) 


Z T 

where  v = {v^^v^}  are  the  components  of  the  earth  relative 
velocities  in  the  local  vertical,  path  pointing  frame 
(LVi'I)  . 

£ 

Cc  = X(a)  is  the  transformation  from  the  (LVWA)  computa 
tional  frame  to  the  LVN  frame. 


~VN 

UE  rm(L)  +h 


(2-27) 


WN  r (L)  + h 


(2-28) 


where  r (L) 
m 


ro(i-c  ) 


, i 2 . 2t  . 

(l~e  sir.  L) 


1/2 


(2-22) 


and  r (L) 

r 


(l-e^  sin^L) 


172 


(2-30) 


rm(L) , r (L)  are  the  meridian  and  prime  vertical  radii  of 
curvature  on  the  surface  of  the  ellipsoid  at  geodetic 
latitude,  L = Lg,  defined  in  Appendix  C. 

rQ  = a,  is  the  sealevel  equatorial  radius  of  the  earth  (or 

the  semi  major  axis  of  the  meridional  ellipse). 

/ b2  \ V2 

e =ll-  ~2~)  Is  the  eccentricity  of  the  meridional  ellipse 
where  b is  the  polar  radius  (or  semi-minor  axis)  . 

WE,WN  are  hhe  level  components  of  the  angular  velocity  of  the 
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vehicle  with  respect  to  the  earth  in  the  LVN  frame,  a>  ^ 


£ * C£  {0  0)e  0)N> 


(2-31) 


where  £=  ujgC  is  the  angular  velocity  of  the  comput  ation  frame 
with  respect  to  the  earth  fixed  frame  in  the  computational 
frame . 

(3)  Derivative  cf  Direction  Cosine  Matrix 


ce  = ce 

c c ec 


(2-32) 


where  Q 


ec 


u 'py 


-p, 

i 

o 

p. 


-p. 


(2-33) 


(4)  Earth's  Rate  and  Gyro  Torquing 


a)?  = (oC  t-  w?  = P + (0*7 

-ic  -ec  -le  — -le 


(2-34) 


g i T 

where  w.  = <o . ={00w.  } 

— le  — xe  le 

T 

j C 6 

and  w.e  = (Cc)  a>ie 


(2-35) 

(2-36) 


(5)  Coriolis  and  Centripetal  Acceleration 


, C , „ C , C f . C » c 

(co  _ + 2 a).  )xv  = (a).  + a).  )x  v 

-ec  -le  - -ic  -l  e - 


(2-37) 


- + 


c c c 

where  and  are  the  skew- symmetric  forms  of  <o^c,  the 

. yro  torquing signals , and  w?e,  the  earth  rate  in  the 


computational  frame. 


2.4.2  Vertical  Channel  Damping 

The  inherent  instability  of  the  vertical  channel  of  any 
pure  inertial  navigator  is  due  to  errors  in  the  computation  of 
2 resulting  from  errors  in  the  computed  altitude  or  due  to 
vertical  accelerometer  errors.  Linearizing  the  expression  for 
the  vertical  component  of  gravity  in  the  previous  section  we 
have 


g*  = g » -g„  (1-C,  h) 
3x  3x  3o  ^1 


(2-46) 


where  C. 


or 


g « - 

3 v 


2gC 

9o  + — 


(2-47) 


The  second  term  on  the  right  is  the  potential  positive  feedback 
term  and  will  result  in  an  exponentially  diverging  altitude 
error  for  the  most  infinitesimal  initial  error.  A block  diagram 
of  the  undamped  vertical  channel  is  show  in  Figure  2-9. 


Figure  2-9.  Undamped  Vertical  Channel  Block  Diagram 
A non-inertial,  external  altitude  reference,  h (generally 

■D 

a barometric  altimeter)  is  incorporated  into  the  vertical  channel 
via  conditional  feedback  loops  as  illustrated  in  Figure  2-10 
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"Baseline"  LVWA  Navigation  Algorithm  (in  Difference 


Equation  Form 

The  equations  mechanized  in  the  "baseline"  LVWA  Navigation 
Algorithm  are  ordered  as  shown  in  Table  2-1.  Each  number  represents 
a fixed  sequence  of  operations  applicable  at  all  levels. 


Table  2-1 


Local  Vertical  Wander  Azimuth  Navigation  Algorithm  with  Vertical 


1 Update  computational  frame  velocities,  (store  old  velocities)* 

2 Add  vertical  damping  terms.  ‘ 

3 Compute  angular  velocities  about  level  axes.  INRNAV  or  ANGVL2 

4 Update  direction  cosine  matrix  (1st  or  2nd  order).  DCMUPD 

5 Orthonormalize  direction  cosine  matrix  (1st  order) . ORTHO 

6 Compute  earth's  rate  signals  j 

*7  Compute  gyro  torquing  signals.  ( TOP.COR 

8 Compute  angular  velocity  [for  (u>xv)  ] . I 

9 Compute  (wxv)At  terms  (for  velocity  update)  ] 

10  Compute  altitude  and  vertical  damping.  INRNAV 

11  Compute  gravity  components.  GRAV 

*12  Extract  position  and  wander  angle.  POSVEL 

*13  Form  wander  angle  matrix  and  LVN  velocities. 


^INRVAV 


POSVEL 


*Shown  as  separate  blocks  in  computational  flow  diagrams. 


General 

Second  level  consists  of  presenting  the  approximate  integrals 
of  the  differential  equations  and  approximation  to  the  other 
functions  in  difference  equation  form,  generally  using  a rectangular 
integration  scheme. 
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Generally,  one  (or  more)  fixed  navigation  computation  cycle (s) 
is  (are)  employed.  Consider  just  one  computation  cycle  for  naviga- 
tion, At,  where  At  is  a binary  fraction  of  a second  for  minimiza- 
tion of  the  computational  load  and  truncation.  Time  in  navigation 
is  set  to  zero  (t=0)  at  the  moment  of  entry  into  navigation  i.e., 
at  the  conclusion  of  initialization;  thereafter  elasped  time  is  up- 
dated by  counting  the  number  of  navigation  computation  cycles  which 
have  elasped  since  initialization.  Time  at  end  of  the  n—  naviga- 
tion computation  cycle  is  denoted  by  tR  where  tn  = nAt. 

The  function  of  the  navigation  algorithm  is  to  update  the 

navigation  parameters  to  t from  their  values  at  tn_^,  based  on  the 

incremental  velocity  and  other  data  available  at  t . In  the  case  of 

n 

a local  vertical  system,  the  navigation  computations  at  tn  must 
also  provide  gyro  torquing  signals  to  be  applied  from  t to  tn+l* 

NOTE:  In  passing  to  the  difference  equation  form,  the  literal  super- 
scripts and  subscripts  designating  coordinate  frames  are  replaced 
by  their  numerical  equivalents  to  correspond  more  closely  with  program 
mnemonics.  The  following  table  will  clarify  the  designations: 


Frame  Name 


Inertial 


Earth-fixed 


Local  vertical,  north 
pointing 


Local  vertical,  wander 
azimuth  or  computational 


Designation 


Literal 


Numerical 


^g*  ■ -i^jpy^^ysKginK*^?*11-  ^>u-  '-  ! - - . - - - r-~.~^r:.-  . 


K:f"'  F 
§t  i 


1.  Update  Computational  Frame  Velocities 

Defining  the  corrected  incremental  velocity  output  of  the  X 
accelerometer-  of  a local  vertical  IMU  at  tn  as 


Av^  <tn)  4 Av 


- nAt 

2’  = f2' 

x lx 
n Jt  n-n 


(T)dt  ~exQx 


(2-51) 


(n-1)  At 


where  Q is  the  quantization  of  the  x-accelerometer  and  -l<e  <1, 

X X 

the  velocity  update  equation  for  the  simplest  algorithm  will  be  written 


v^(„,  . v2(d>  + AV2'  + \£-  (fl2;  ♦ 2a2’  V,2'  ] 

n-1  L \ n-1  n-1/  n-1  J 


At  (2-52) 


where 

21 

v (u)is  the  velocity  vector  in  the  2'  frame  at  time  t un- 
'*  n 

damped  i.e.  without  the  addition  of  the  vertical  damping 
correction. 

2' 

v (d)  is  the  damped  velocity  vector  in  the  2’  frame  at  time  t 
“n-1  n-1 

2'  . 

Av^  is  the  vector,  one  component  of  which  is  given  oy  Eqn  (2-51). 
2 ' 

2n_l  is  the  gravity  vector  in  the  2’  frame  computed  at  time 
(or  (n-1)  At)  . 

2 1 

^q.  2'  1S  tlie  skew  symmetric  form  of  the  angular  velocity  of  the 
r n- 1 

2'  frame  with  respect  to  the  O' -frame  expressed  in  the  2' 

p » 

frame  and  computed  at  time  t , w*,  ,, 

n-1 

2 1 

^0  O'  i®  tlie  skew  symmetric  form  of  the  angular  velocity  of  the  O' 

f n—  1 

frame  with  respect  to  the  0-frame  expressed  in  the  2'  frame 
and  computed  at  time  t 

At  is  the  navigation  computational  cycle. 


2.  Add  Vertical  Damping  Terms 

Vertical  damping  terms  are  added  for  one  component  of  velocity 


viz: 


vx’(d)  = vx'(u)  + (C26hn-l  + 6an-l)At 
n n 


(2-53) 


where  the  subscript  x refers  to  the  first  or  vertical  component  of 
velocity  in  the  2'  frame 


C2  is  a constant 


^hn-l=hB  ~hn-l 
n-1 


hn  is  the  reference  (barometric)  altitude  at  t , 

Vl  11-1 


hn_^  is  the  system  computed  altitude  at  t ^ 

A 

6an_^  is  defined  by  Eqn.  (2-67)  with  n replaced  by  n-1 


3 . Compute  Angular  Velocities  About  Level  Axes 


The  level  components  of  the  angular  velocity  due  to  vehicle 

2 ' 

motion  over  the  earth,  2 , or  £ computed  using  the  approximate 
equation  are: 


2' 


V,2* 


n 


Y -fc:  )21 

o L \ n-1/ 33  \ 1 n-l/32J 


.2' 


- e ) (c°2'  ) 

) \ z n-1/ 32  \ z n-1/33 


I h , 

/ \ 2 

\2  1 

1 ■ 3(c°’ ,), 

9 " f 

,o*  r 
'2  ’ , / 

i ° 

\ n-l/3 

2 \ 

n-1  /3  3 J 

(2-54) 


^e(c2o;  ,)  (#  ) 

-o  \ n-1/32  \ z n-1/ 


33 
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» Hm  a r.^-ryp 


NOTE: 


,2' 


n 


Ao 


where  rQ  is  a constant  equal  to  the  equatorial  sea  level  radius 

of  the  earth,  a,  i.e.,  the  semi-major  axis  of  the  meridional 
ellipse;  e is  a constant  equal  to  the  ellipticity  of  the 
meridional  ellipse,  i.e.  the  difference  between  the 

semi-major  and  semi-minor  axes  of  the  meridional  ellipse 
divided  by  the  semi-major  axis;  hn_^  is  the  system  com- 
puted altitude  at  time  tn_^. 

] is  the  second  element  of  the  third  row  of  the  LVWA  to  earth 

n-1/32  fixed  transformation,  0°', , at  time  tn-r  It  is  equal  to 

-cosL  . sinot  . . 
n-l  n-i 


Hv.) 


is  the  third  element  of  the  third  row  of  the  LVWA  to  earth 
33  O' 

fixed  transformation,  C2, > at  time  tn_^.  It  is  equal  to 


cosL„  , cosa  . . 
n-i  n-i 


01 


.2' 

i0' 


, th 


NOTE: 


where  i®x,y,z,  is  the  i component  of  the  angular  velocity 

1 

n of  the  (LVWA)  comoutational  (2')  frame  with  respect  to 
the  earth  fixed  ( 0 * ) frame  expressed  in  the  2’  frame- 
computed  at  time  tn_^. 

(a)  Due  to  the  similarity  in  the  expressions  for  the  y and  z 

2 ' 

components  of  u.,,,  , many  computational  simplifications 

n 

can  be  realized  in  the  actual  mechanization  of  these  ex- 
pressions. 

2 ' 

(b)  For  compactness  of  notation  the  elements  of  uj,  are 


frequently  expressed  as  p.  where  l«x,y,z. 

ln 


n 
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where 

O 

o o 
31 

= c! 

!E 

o o 

o’ 

n 

n 

n 

since 

c0'  = 
‘-'O 

Z(to0) 

, O' 

n 

. o 

and  Wq 

,0’  = 

{0  0 

© 

o o 

3 

T 

} 

where 

o 

o o 
3 

o o 
3 

II 

1 

,0' 

w . 
ie 

of  the  earth  in  the  inertial  frame.  to-e  is  entirely  along 
the  z axis  of  the  inertial  or  earth  fixed  frames. 


7.  Compute  Gyro  Torquing  Signals 


2' 


Gyro  torquing  signals,  tog  are  computed  viz: 


2'  2'  2' 
ton  — to..  » , + to  , 

-u,z  n 0,0  n -0  n 


(2-58) 


where  o>g  2,  is  the  total  angular  velocity  of  the  LVWA  gyros  with 

inertial  frame  required  to  maintain  the  LVWA  platform  in  the 
desired  orientation  (no  gyro  drift) . 

NOTE:  (a)  the  values  shown  in  (2-58)  are  those  rates  which  will 

be  applied  continuously  from  tn  to  tn+^.  If  the  angle 

to  be  torqued  is  required  both  sides  of  the  equation  are 
multiplied  by  At. 

8.  Compute  Angular  Velocity  (for  wxv) 

The  angular  velocity  for  the  Coriolis  and  centripetal  terms 
is  computed  viz: 


-0 ' , 2 ' „ + 2— 0 , 0 ' “ -0,2'  + 4,0'  4 % 

n n n 


n 


(2-59) 


where  wn  is  introduced  for  compactness  of  notation. 

For  the  velocity  update  function,  ton  is  multipled  by  At. 


NOTE: 


9.  Compute  (wxv) At  (for  velocity  update) 

The  Coriolis  and  centripetal  portion  of  the  velocity  update 
is  computed  viz : 


(V4')4t  * '(O0'.2'n  +2(!o!o'J^'4t 


(2-60) 


? 1 2 
where  QI  is  the  skew  symmetric  form  of  uQ  Ql 


n 


and  all  other  terms  have  been  defined  earlier . 

10.  Compute  Altitude  and  Vertical  Damping 

The  altitude  and  vertical  damping  terms  are  computed  viz: 


n = 

: Vl  + 

V* 

6hn 

= hBn  " 

h 

n 

A 

A 

6an 

= 6a  . 
n-1 

+ C 

(2-61) 


wheie  h is  the  system  computed  altitude  at  time  t 
11  n 

C^  is  a vertical  damping  constant  (sec-1) 

h .is  the  (barometric)  reference  altitude  at  t 
n n 

^h^  is  the  difference  between  the  barometric  and  system 

computed  altitudes  at  time  t . 

n 

C3  is  a vertical  damping  constant  (sec-3)  (C3  may  be  equal 
to  zero) . 

<$an  is  C3  times  the  approximate  integral  of  the  computed 

altitude  difference  from  t=0  to  t=t  . 

n 
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ii*  Compute  Gravity  Components 

The  components  of  gravity  in  the  computational  frame  q2' 
are  oomputed  viz: 


■n 


a = - 


C + C 
go  g2 


(C°:X  + C^4  (C°:„) 


2 

31 


1 Is  - \ (C°:J32jhn 

2) 

2 n j 


s,  = 


s h-  (C°:„L  K) 
h-  K) 


+ C,  h 
h_  r. 


(2-62) 


C0' 

31  \ z n/33 


where  g.^  for  i=x,y,2,  are  the  components  of  gravity  in  the  computa- 
tional (2')  frame  computed  at  t. 

’n 

and  c , C , C are  constants  in  the  gravity  equations  with 
■*0  “2  y4  . o 

units  of  (feet/sec) 

Ch  ' Ch  are  constants  in  the  gravity  equations  with  units  of 

1 4 (feet  -1) 

C,  is  a constant  in  the  gravity  equations  with  unit  of 

2 -9 
(feet  z) 

Cjj  is  a constant  in  the  gravity  equations  with  units  of 


V n/3j. 


(sec  2) 

where  j = 1,  2,  3,  are  the  elements  of  the  third 

G ' 

row  of  matrix  C_,  at  time  t 
“ n 


m 


r 
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NOTE:  (a) 


Before  being  applied  cs  corrections  in  the  velocity 

2 ' 

equation  (2-52)  the  g,  are  multiplied  by  At 

xn 

(b)  • For  compatibility  with  the  accuracy  of  the  remainder 

of  the  "baseline"  algorithm,  the  constants,  , 

Ch  , Ch  , should  be  set  to  zero.  This  would  provide 
2 4 

a gravity  model  of  slightly  greater  accuracy  than 
those  employed  by  most  of  the  systems  surveyed. 

• The  form  and  constants  employed  in  Equation  (2-62)  are 
those  of  the  WGS72  Ellipsoidal  Earth  Gravity  Model 
(same  as  "upgraded"  aJgorithm). 

• The  value  of  these  parameters  arc  not  under  operator  control. 

• Effects  of  gravity  model  variation**  on  navigation  and 
attitude  accuracy  are  not  among  the  parameters  to  be 
included  in  this  study. 


1 2 . Extract  Position  and  Wander  Angle 

Position  and  wander  angle  are  extracted  from  the  direction 
0 1 

cosine  matrix,  C_,  , viz: 

* n 


(2-63) 


(2-65) 


where  Ln  is  the  geodetic  latitude  (positive  north  of  equator)  at  time 


NOTE: 


Xn  is  the  geodetic  longitude  (positive  east  of  Greenwich) 

at  time  t . 

n 

X0  is  the  geodetic  longtiude  at  t-0 

an  is  the  wander  angle  (positive  to  the  east  of  north)  at  tn 

/ o’  \ / o'  \ 

If  l C 2 « n #i i an<^  VC2,n)21  are  zero  than  the  system  is 

exactly  at  the  north  or  south  pole  and  both  X n and  an  are 
indeterminate  therefore  the  previous  values  will  be  out- 
put as  long  as  these  conditions  persist. 


13.  Form  Wander  Angle  Matrix  and  LVN  Velocities 

Sine  and  cosine  of  wander  angle  are  used  to  transform  velocity 
from  computational  (2')  frame  to  local  vertical  north  pointing  (LVN 
or  2)  frame  viz: 


2 2 2 ' 
- c . v^ 
— n 2 n -n 


(2-66) 


where  C t.,  = X(a  ) 

2 ' n 


n 


cosa  sina 
n n 


LO  -sina,,  cosa 
n n 


2 

and  vn  is  the  earth  relative  velocity  in  the  LVN  frame  at  tn- 
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2. 4. 3.1  Upgrading  Baseline  Navigation  Algorithm 


2. 4. 3. 1.1  Introduction 

The  "baseline"  navigation  algorithm  presented  in  the  previous 
section  may  be  considered  as  representative  of  moderate  accuracy, 
local  vertical,  inertial  navigators  developed  in  the  mid-to-latter 
1960's. 

The  Inertial  Measurement  Unit  (IMU)  generally  interfaced  with 
a dedicated  navigation  computer,  which  was  normally  a small,  fixed 
point,  general  purpose  machine,  typically  with  a 24-bit  data 
word.  Speed  was  moderate  and  operations  like  division  were  to 
be  avoided  if  at  all  possible,  while  subroutines  like  square  roots 
were  not  considered  for  the  high  speed  loops.  Navigation  computa- 
tion cycles  were  on  the  order  of  2 to  20  Hz. 

Considerable  ingenuity  was  devoted  to  the  development  of 
"baseline"  algorithms  that  primarily  involved  the  arithmetic 
operations  of  addition  and  multiplication  plus  loads,  stores,  and 
shifts. 

Further  ingenuity  was  involved  in  optimum  scaling  of  the 
variables;  the  use  of  binary  computation  cycles  for  the  integra- 
tions obviated  the  necessity  to  perform  multiplications  in  many 
cases  or  replaced  the  multiplication  by  a shift. 

The  net  result  was  a compact,  efficient,  assembly  language 
program,  optimized  - insofar  as  the  constraints  of  time  and  money 
permitted  - for  the  particular  computer,  IMU,  and  mission. 

The  local  vertical  wander  azimuth  navigation  algorithms  surveyed 
integrated  linear  acceleration  once  to  obtain  linear  velocity 
(three  components);  converted  linear  velocity  to  angular  velocity, 
and  integrated  the  latter  once  to  obtain  angular  position. 

First  order  algorithms  were  used  throughout.  In  integrating 
the  v ( denotes  differentiation  with  respect  to  time)  equation, 
it  was  assumed  that  the  acceleration,  a,  was  constant  over  the 
navigation  computation  cycle.  At;  hence 


2-56 


.t+At 

I a{T)dt  = a(t)  At  (2-67) 

J t 

This  implied  that  a(t),  a(t),  etc.  were  all  equal  to  zero. 

Similarly,  in  integrating  angular  velocity,  w,  it  was  assumed 
that  co  was  constant  over  the  navigation  computation  cycle,  At, 
and  further  that  |toj  = (w  w)  ' , is  sufficiently  small  that  the 
co^Wj  terms  are  negligible;  hence  the  direction  cosine  matrix,  C, 
containing  the  angular  position  variables  is  updated  by 

C(t  + At)  = C(t)  [I  + ft  At]  (2-68) 

where  I is  the  3x3  identity  matrix  and  ft  is  the  3x3  skew  symmetric 
matrix  corresponding  to  o>.  This  implied  that  u>(t)  , co(t),  etc. 
were  all  equal  to  zero.  Compatible  approximations  in  the  conversion 
of  linear  to  angular  velocity,  in  the  computation  of  gravity  (the 
resultant  of  mass  attraction  and  centripetal  force)  , and  in  the 
trigonemetric  (sine-cosine)  and  inverse  trigonometric  (arctangent) 
functions,  were  also  part  of  the  "baseline"  navigation  software. 

The  objective  of  the  algorithm  upgrade  operation  is  the  removal 
some  of  these  assumptions  or  approximations  on  an  as-needed  basis 
to  permit  the  airborne  navigation  computations  to  approacn  the 
accuracy  of  the  PROFGEN  outputs,  which  are  considered  to  be 
perfect. 

2 . 4 . 3 . 2 Approacn 

The  "baseline"  navigation  equations  were  incorporated  into 
the  numerical  simulator  (NUMSIM)  and  a number  of  short  simulations 
were  performed.  The  errors  in  position,  velocity  and  attitude  rela- 
tive to  PROFGEN  output  were  examined  and  the  most  significant  were 
analyzed,  using  expanded  printouts  where  necessary.  When 
the  offending  routine  was  identified,  its  performance  was  analyzed 
and  a more  precise  routine  was  devised,  coded  and  tested.  Then 
the  procedure  was  repeated  for  the  most  significant  remaining 
errors.  The  user  is  provided  the  options  of  "burning  on"  the 
upgraded  algorithms  by  setting-  one  or  more  flags  to  non  zero  values. 
This  procedure  is  described  in  the  User's  Guide  in  Volume  III. 
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2.4.4  Improved  Accuracy  Navigation  Algorithm 

The  equations  mechanized  for  the  "ideal  simulator  LVWA 
Navigation  Algorithm  incorporate  all  the  "upgrades"  discussed  in 
the  previous  section.  In  the  main,  the  upgrades  consist  of  a 
certain  amount  of  interpolation  and  extrapolation  'f  the  naviga- 
tion variables.  The  object  of  these  operations  is  to  correct 
the  "phasing"  of  the  scalars,  vector,  and  matrix  variables  so 
that  a higher  order  integration  algorithm  is  effectively  mechan- 
ized — but  with  little  more  computational  load  than  is  required 
for  the  simple  "baseline"  software. 

The-  main  addition  to  the  algorithm  is  the  repetition  of 
the  angular  velocity  computations  — for  the  first  pass,  the 
interpolated  velocities  are  used  to  generate  angular  velocities 
for  the  direction  cosine  matrix  update,  while  the  second  pass 
uses  the  extrapolated  velocities  to  generate  che  torquing  signals 
and  the  Coriolis  and  centripetal  corrections. 

The  routines  are  summarized  in  Table  2-3.  The  form  of  the 
difference  equations  used  in  the  routines  is  listed  as  follows: 

1.  Updated  Computational  Frame  Velocities 


2’  2’  2' 
— n (u)  = ^(d)n-l  + — n 


(2-69) 


2* 

3 n-1/2 


-(<•  2. 

\ J ' n-1/2 


+ 2Q 


0,0’. 


n-1/2 


At 


Note:  The  variables  with  subscript  (n-1/2)  are  the  extrap- 
olated values  computed  at  t ^ i.e.,  (n  - 1 + 1/2) . 

2.  Add  Vertical  Damping  Terms 


vx’(a)  “ + (C2Sh„-l/2  + «Vl/2  -n-l/2)  4t  <2"70> 


Note:  The  (d)  and  (u)  are  not  employed  in  the  subsequent 
equations  since  only  v(d)  is  saved. 
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Im. 


TABLE  2-3 


Routines  for 

Upgraded  LVWA  Navigation  Algorithm  with  Vertical  Damping 


Sequence 

No.* 

Function 

Comments 

1. 

Update  computational  frame  velocities 

from  (n-1)  to  n, 
store  old  velocities 

2 . 

Add  vertical  Damping  terms 

2a. 

Interpolate  and  extrapolate  velocities 

to  (n-1/2)  and 
(n+1/2) 

3. 

Compute  angular  velocities,  p,  about 
level  axes,  for  d.c.m.  update,  using 
interpolated-  updated  velocities  and 
extrapolated  a,  L,  h. 

(at  (n-1/2) 

4. 

Update  direction  cosine  matrix 

to  n,  using  p from 

3 and  2nd  order 
algorithm 

4a. 

Extrapolate  direction  cosine  matrix 

tc 

(n+1/2) 

5. 

Orthonomalize  direction  cosine  matrix 

10. 

Compute  altitude  and  vertical  damping 

extrapolate  h,  <$h, 
store  as  old  value 

11. 

Compute  gravity  components 

using  extrapolated 

L,  h 

12. 

Extract  position  and  wander  angle 

store  old  a 

13. 

Form  wander  angle  matrix  and  LVN 
velocities 

extrapolate  wander 
angle  sin  - cos 

3a. 

Compute  angular  velocities  about  level 
axes 

extrapolated  to 
(n+1/2) , for  torquing 
and  (w  x v)  using 
extrapolated  V,  a, 

L,  h 

6. 

7. 

Compute  earth's  rate 

Compute  gyro  torquing 

1 

using  extra- 
polated d.c.m. , 

8. 

Compute  angular  velocity  for  (u  x V) 

V,  p 

9. 

Compute  (w  x V)  At  for  velocity  update 

•Sequence  numbers  correspond  to  those  used  in  the  baseline"  algorithm 
(see  Table  2-1) . Additional  or  repeated  steps  are  indicated  by  a suf- 
fix "a". 


la.  Interpolate  and  Extrapolate  Velocities  I to  (n-1/2)  and  (n+1/2)] 


2'  1 / 2'  2'  \ 
-n-1/2  ~ 2\Zn+  -n-l) 

1 /,  2 ' 2 ' \ 
2P»  - — n-l / 


(2-71) 


— n+1/2 


3 . Compute  AnguLa r Velocities  about  Level  Axes 

Transform  level  components  of  velocity  to  LVN  frame 


2 2' 

v = v 

yn-l/2  yn-l/2 


cos  V-l/2  + vz 


sm  a 


n-1/2 


n-1/2 


(2-72) 


2 2'  2 ’ 

v =~v  sin  an_i/2  + v 

zn-l/2  yn-l/2  zn-l/2 


cos  a 


n-1/2 


Compute  E and  N conraoner.ts  of  anaular  velocity 

2 


-v 


zn-l/2 

“V1/2 ' hn;V2  ^ 

r„(l-e)2 

. ). 

' 

:n 

(2-73) 


-‘n-1/2 


V-l/2  h 


n-1/2  +)=- 


1-e 


W~J] 

' n-1/2/ 31 J 


172 


Transform  angular  velocity  to  computational  frame 


= 0 


n-1/2 


p„  = cos  a_  *i/o  — sin  a , /0  (2-74) 

yn-l/2  En-l/2  n"1/2  Nn-l/2  n"1/2 


'n-1/2 


= a) 


„ sm  a + <oM  cos  a , /0 

En-l/2  n“1/2  Nn-l/2  n_1/2 
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where 


Si-1/2'  an<^  ^ = Y*  z>  are  east  and  north  components  of 

velocity  at  time 


an-l/2  Nn-l/2 


n-1/2 


are  the  y and  z components  of  2 
i.e.,  the  level  components  of  the 
angular  rate  of  the  vehicle  with  respect 
to  the  earth  fixed  frame  in  the  LVN 
frame  at  tn_;jy2'  t*ie  mid-point  of  the 
nth  computation  cycle. 


P 


• v , hz  are  the  x,  y,  and  z components  of  uyn  , „ , 

n-ly2  ■‘n-1/2  n-1/2  Jf  0',2'n_ 


n-1/2 


(c°;  ) 

\ 2 n-1/2 /31 


i.e.,  the  components  of  the  angular 
rate  of  the  vehicle  with  respect  to 
the  earth-fixed  frame  expressed  in 
the  computational  frame  at 
is  the  square  of  the  first  element  of 
the  third  row  of  the  transformation 
from  the  computational  frame  to  the 
earth  fixed  frame  (the  direction  cosine 
matrix)  at  tn_^(/2'  is  e<3ua^  to 
sin  Ln-l/2 " 

4.  Update  Direction  Cosine  Matrix 

0 ' 

The  direction  cosine  matrix,  C_,  xs  updated  (to  the 

2 n-1 

second  order)  using  the  p . computed  above  viz: 

1n-l/2 


= c; 


2 ' n 


n-1 


' L2’  / 2.  \2 

' ' O’ ,2’  . /0  At  + (n2  ) 

n-1  L n-1/2  \°  '2  n-l  /2j 


At 

2 


(2-75) 
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and  ft 


2 < o 1 

where  firt,  0,  xs  the  skew  symmetric  form  of  p ...  or  u.,  ,, 

, 0 '2  n-1/2  -n-1/2  -0  ,2  n_ 

2' 


\2 


1/2 


°'2' n-1/2) 


is  the  square  of  the  above  matrix. 


Note:  The  nature  of  the  interpolated  2n-i/ 2 is'such  that 
some  portions  of  a third  and  higher  order  update 
are  incorporated,  while  the  form  is  only  second  order 
(see  Appendix  D). 

4a.  Extrapolate  Updated  Direction  Cosine  Matrix 


C°’  = c° ' + — 

2 n+l/2  2 n 


O'  2 ' 

c;,  a»,  ?•  At 

2 n-l  0,2  n-1/2 


c°Vi  H’-2' n-1/2) 


2 2 


(2-76) 


O'  . 0 

where  C„,  is  C~,  extrapolated  to  the  midpoint  of  the  next 

2 n+l/2  2 n 

computation  cycle 


and 


is  the  update  matrix  added  to  C, , to  update  it  to 

2 n-1 


C?l  (see  Equation  2-75) 

“ n 

5.  Orthonomalize  Direction  Cosine  Matrix 

This  operation  is  i .entical  to  that  performed  in  the 
"baseline"  case.  Equation  (2-56)  is  repeated  below  for  completeness. 


O'  O'  10' 

C”,  (ortho)  * c”,  " f c2' 

n n n 


.(*.) 


T „0' 


- 1 


(2-56) 


10.  Compute  Altitude  and  Vertical  Damping 


The  altitude  and  vertical  damping  terms  are  computed  viz: 


h = h , + v‘  + C.  6h 
n 11-1  \ xn-l/2  1 


h„+l/2  * \ + lVf4t 

hB  + 1 { 3hB  hB  ) 

Bn+t/2  2 ' n n“l' 


n-1/2  )' 


n+1/2 


= \*l/2  " hn+1/2 


(2-77) 


Store  h. 


as  h. 


n+1/2  n-1 

“n+1/2  ’ ®„-l/2  + =3ihn+l/2  “ 

11.  Compute  Components  of  Gravity 

The  components  of  gravity  in  the  computational  (LVWA) 
frame,  at  fcn+^/2'  are  comPuted  for  the  WGS  72  Ellipsoid  viz: 


n+1/2 


= C +C  fc°’  \2  + C / c° ! \2  1 

. g0  g2  \ 2’ n+1/2 /31  g0  \ 2 ' n+l/2/3i  j 

l1  " [%  " Ch4  (C°'n+1/2)3J  h"+1/2  + C»2^1/2'j 


Jy  = Ch  hn+l/2 

n+1/2  0 


= -C, 


n+1/2 


n+1/2  (c  2'  +i/2)  (C2'n+1/2) 

31  32 

^n+i/2  ( C2 ' ) (c2-  ) 

n+1/2  \ 2 n+1/2/31  \ 2 n+1/2 /y. 


(2-78) 


where  g.  , for  i = x,  y,  z,  are  the  components  of  gravity  in 

n+1/2 

computational  (2')  frame  at  tn+jy9. 


n+1/2 


for  3=1,  2,  3,  are  the  elements  of  the  third 
row  of  the  transformation  from  the  computational 
frame  to  the  earth-fixed  frame,  extrapolated 

to  tr»+l/2  * 


hn+l/2 


is  the  altxtuae  extrapolated  to  t 


n+1/2* 


Note:  All  the  constants  in  Equation  (2-78)  the  same  as  in 


Equation  (2-62). 

12.  Extract  Position  and  Wander  Angle 

This  operation  is  identical  to  that  performed  in  the 

"baseline"  case.  Equations  (2-63,  2-64,  2-65)  are  repeated  below 
for  completeness: 


(2-63) 


(2-64) 

(2-65) 


Note:  Before  a is  computed,  the  previous  value  of  a is 
stored  as  ctQ. 

13 . Form  Wander  Angle  Matrix  and  LVN  Velocities 

The  fundamental  operation  is  identical  to  that  performed 
in  the  "baseline"  case.  Equation  (2-66)  is  repeated  for  complete- 


ness. 


Compute  E and  N components  of  angular  velocity 

,2 


Uir 


-v: 


J n+1/2 


Jn+l/2 


*n+l/2 


( ro  (1  - E 

2>  ) 

k:  )2 

\ n+1/2/ 31 

3/2J 

(2-81) 


N 


n+1/2 


n+1/2 


hn+l/2 


4 fo 

1 1*  - to. 


1/2  i 


n+1/  2 / 32. 

Transform  angular  velocity  to  computational  frame 


Xn+l/2 


A 0 


C = (0_ 

yn+l/2  E 


n+1/2  cos  “n+1/2  “ WNn+1/2  Sin  “n+1/2  (2-82) 


n +i/2 
Note : 


= oj_  since  ..  /0  + a>M 

En+l/2  n+1/2  Nn+l/2 


cos  a 


n+1/2 


(a)  The  variable  definitions  accompanying  Equation 

(2-7  3)  apply  here  - only  the  time  has  been 
advanced  from  tn_1/2  tn+1/2- 

(b)  The  values  of  sin  an+^/2  an<^  cos  an+l/2  are 
stored  in  locations  for  the  "extrapolated  sin- 
cos  of  a",  and  will  be  used  as  sm  an_]_/2  anc* 
cos  ^n„i/2  w^en  Equation  2-73  is  used  on  the  next 
computation  cycle. 

(c)  A similar  comment  to  (b)  above,  applies  to 


(C2 ’n+l/2)' 
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6 .  Compute  Earth's  Rate  Signals 

The  earth's  rate  signals  are  computed  in  the  same 

manner  as  for  the  "baseline"  case,  (Equation  (2-5'7))  t except  that 

0 ' 

the  extrapolated  direction  cosine  matrix,  C9,  , is  employed. 

* n+1/2 


J0,0' 


n+1/2 


/„0'  \t  O' 

1^2 1 I —0  0 1 

\ 2 n+1/21 


(2-83) 


sinLn+l/2,“cosLn+l/2  sinan+l/2, cosLn+l/2  cosan+l/2V 


7.  Compute  Gyro  Torquing  Signals 

2 ' 

Gyro  torquing  signals,  o>_  , , are  com- uted  m 

0,2  n+1/2 

the  identical  manner  +.o  that  employed  in  the  "baseline"  case. 
Equation  (2-58)  except  that  the  variables  are  extrapolated  to 

fcn+l/2* 


-°' 2 ’n+1/2 


“0'0’ n+1/2  ~° ’ f 2 * n+1/2 


(2-84) 


V * 

where  u>f,  is  P , . ,,  as  computed  in  Equation  (2-81). 

' n+1/2  n+±/ 2 

8.  Compute  Angular  Velocity  (for  w x v) 

Angular  velocity  for  the  Coriolis  and  centripetal  terms, 
—n+1/2  comPutec^  as  in  Equation  (2-59)  for  the  "baseline"  case, 
except  that  the  extrapolated  variables  are  used: 


iiiW 


—n+1/2  ~®,2'n+1/2  + ~0 » 0 ' n+1/2 


(2-85) 
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9.  Compute  (u>  x v)  At  (for  velocity  update) 

The  Coriolis  and  centripetal  portion  of  the  velocity 
update  is  computed  in  the  same  manner  as  in  Equation  (2-60)  for 
the  "baseline"  case,  except  that  the  extrapolated  values  (to  fcn+i/2^ 
are  employed. 


■n+1/2  * -n+1/2 


) At  - -(®0,  2' 


+ 20. 


n+1/2 


0,0' 


n+ 


\ 2' 

J 


n+1/2 

(2-86) 


At 


General  Note:  The  extrapolated  variables  computed  by 


Equation  (2-77^  through  (2-86),  at  t , become 
the  interpolated  variables  used  in  Equations 
(2-69)  through  (2-73),  at  t 


2-68 


2 . 5 Attitude  Computations 

Attitude  computations  for  the  three  IMU  types,  all  employing 

a local  vertical  wander  azimuth  (LVWA)  computational  frame,  differ 

only  in  the  manner  of  constructing  the  transformation  from  the  body 

c 2 ' 

frame  to  the  LVWA  computational  frame  or  C,.  . 

2.5.1  Local  Vertical  Wander  Azimuth  IMU 

A four  gimbal,  local  vertical  IMU  is  considered  since  attitude 

may  be  read  out  directly, in  the  three  gimbal  case.  In  this  case, 

2 ' 

C,-  is  the  LVWA  gimbal  angle  matrix.  The  generation  of  this  matrix 
is  described  in  detail  in  Appendix  A,  Section  A. 4. 7 of  this  volume. 

2.5.2  Space  Stablized  IMU 

All  gimbaled,  SS  IMU's  have  four  gimbals.  The  SS  gimbal  angle 
matrix  or  transformation  from  the  body  frame  to  the  space  stable 
platform  frame,  or  C^°,  is  described  in  detail  in  Appendix  A, 

Section  A. 4. 6 of  this  volume.  However,  this  is  only  the  first  step 

2 ' 

in  generating  C,.  for  a space  stable  IMU  with  a LVWA  computational 
frame.  The  total  transformation  is  given  by: 


= Cc  C?  C1  c£ 
b e l p b 


or 


2 ' 2 ' O'  0 

= Cr  Cu  C C 
5 V 0 10  o 


10 


where  or  is  the  space  stable  alignment  matrix  (a  constant 
for  this  study)  - see  Appendix  A,  Section  A. 4. 8 
of  this  volume. 

0 ' e 

Cq  or  is  the  single  axis  rotation  representing  the  inertial 


to  earth  fixed  transformation 
above . 


see  same  section  as 


'O' 


or  Ce  is  the  transpose  of  the  LVWA  "direction  cosine  matrix 
- see  Appendix  A,  Section  A. 4. 5 of  this  volume. 


2.5.3  Strapdown  IMU 


The  body-to-computational  frame  transformation,  C^,  is  an 
integral  part  of  the  (high  speed)  strapdown  computations.  Its 
generation  is  described  in  detail  in  Section  2.3.3  of  this  volume. 

2.5.4  Attitude  Extraction 

This  operation  is  common  to  all  IMU  types  with  a LVWA  computa- 
tional frame,  and  is  described  in  detail  in  Sections  A. 4.4  and 
A. 4. 9 of  this  volume. 

It  should  be  noted  that  roll  and  yaw  are  indeterminate  when 
pitch  is  + 90°. 


2.5.5  Attitude  Predictor-Filter 

The  attitude  predictor  filter  accepts  the  computed  attitude 
angles  (roll,  pitch  and  heading)  as  inputs  and  outputs  filtered/ 
predicted  values  of  the  attitude  angles  their  angular  rates  and 
angular  accelerations.  It  employs  precomputed  gains,  selected  on 
the  basis  of  the  observation  residuals  (the  difference  between 
the  computed  and  estimated  attitude  angles) . If  the  residual  is 
less  than  a preassigned  maximum,  the  gains  are  incremented  towards 
the  steady  state  values;  conversely,  if  the  residual  equals  or 
exceeds  the  maximum,  gains  are  decremented  toward  the  initial 
values,  where  complete  reliance  is  placed  on  the'  computed  attitude 
angle.  The  procedure  is  repeated  for  each  attitude  angle. 

A block  diagram  of  the  filter  is  presented  below  (for  a single 


Figure  2-11.  Attitude  Predictor-Filter  Block  Diagram 
(Single  Axis) 

where  is  the  computed  (measured)  attitude  angle  at  t . 

n 

0“  is  the  estimated  attitude  angle  at  t , prior  to  the 
En  n 

update. 

0 = 0,,  - 0„  is  the  observation  residual  at  t . 

r E„  n 

n n n 

K is  the  3x10  gain  matrix. 
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j is  the  column  of  the  gain  matrix  from  the  gain  select 


logic,  where  j = j ,+l  unless  K = 10. 
3 Jn  Jn-1— 

M = {1  0 0}  is  the  measurement  matrix 


$ is  the  state  transition  matrix 

2' 

1 At 


where  $ A 


At 


1 

0 


2 

At 

1 


60 


«E 


ii 


= K.  A0  is  the  update  to  the  attitude  state, 
n . ..  T 


{ 60~  60 


n 


E S6E  > 
n n 


_ * _ _ m 

= {0„  0_  0_  } is  the  estimated  attitude  state  at  t , 

b tj  £j  n 

n n n 

prior  to  the  update, 

= (0„  +60„  0^  +60_  0 +60_  }T  is  the  estimated  attitude 

b b b b b b 

n n n n n n 


state  at  tn,  after  the  upate. 

At  is  the  attitude  computation  cycle. 

Three  passes  through  the  filter  are  required  to  update  all  three 
attitude  angles  and  their  derivatives,  which  are  then  stored  in  a 
3x3  attitude  state  matrix. 

It  should  be  noted  that  the  particular  gain  matrix,  K,  was 
that  considered  -'pplicable  for  the  SPN/GEANS,  and  may  only  be  applied 
when  attitude  is  computed  at  32  Hz.  Generally,  the  gains  are  obtained 
from  a two  step  simulation  program.  In  the  first  step  the  vehicle 
dynamics,  the  estimated  initial  errors  in  angular  position,  velocity, 
and  acceleration,  the  actual  and  estimated  encoder  noises,  the 
iteration  time,  the  ratio  of  the  iteration  to  the  desired  truncation 
time,  the  iterations  from  which  gains  are  to  be  stored,  and  several 
other  control  parameters  are  input.  The  run  is  perlormed,  including  a 
statistical  analysis  of  the  errors,  using  a recursive,  exponentially 
age  weighted,  least  squares  filter.  In  the  second  step,  the  run 
is  repeated  using  the  precomputed  gains  (i.e.  the  same  filter  config- 
uration as  previously  described)  and  the  instantaneous  and  statistical 
errors  are  compared.  A number  of  repetitions  of  the  process,  with 
judicious  variation  of  parameters  should  lead  to  a best  gain  matrix, 
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SECTION  3 


SUMMARY  OF  INS  NAVIGATION  COMPUTATIONS 

3.1  Introduction 

This  Section  contains  a general  functional  description  of 
the  INS  navigation  software  mechanizations,  based  on  the  survey 
results  presented  in  Section  1. 

The  following  INS  configurations  are  included  in  this 
description: 

1.  INS  with  a local  level  stabilized  platform 

2.  INS  with  a space  stabilized  platform 

3.  Strapdown  INS 

The  computational  frames  included  in  this  description,  are: 

1.  Local  level,  geodetic,  wander  azimuth 

2.  Space  stabilized 

The  resultant  six  types  of  computations  are  categorized  in 
Figure  3-1.  The  figure  numbers  shown  in  the  tabulation  refer  to 
the  block  diagrams  of  th«.  navigation  computations,  presented  in 
this  Section. 

The  proposed  standardized  symbology  of  frames  and  transfor- 
mations, presented  in  Section  6,  is  used  in  the  overview  descri- 
bed in  this  section. 

3.2  Summary  and  Conclusions 

The  general  functional  description  of  INS  software  mechaniza- 
tion is  used  to  illustrate  the  commonality  and  differences  in 
navigation  computations  for  three  types  of  INS  configurations  (a 
local  level,  a space  stabilized  and  a strapdown  INS) . Both  rhe 
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INS  CONFIGURATION 


COMPUTATIONAL 

FRAME 


LOCAL  LEVEL 


SPACE  STABILIZED 


LOCAL 

LEVEL 

STABILIZED 

PLATFORM 

SPACE 

STABILIZED 

PLATFORM 

FIG.  3-3,  34 

FIG.  3-3,  3-5  • 

FIG.  3-7,  3-8 

FIG.  3-7,  3-9 

STRAPDOWN 


FIG  3-3,  3-6 


FIG.  3-V,  3-1 C 


Figure  3-1.  Categorization  of  the  INS  Computations 

local-level  wander-azimuth  and  the  space-stabilized  computational 
frames  are  included  in  this  description. 

The  commonality  of  navigation  computations  of  position  and 
velocity  in  both  computational  frames  starts  with  the  velocity 
increments  sensed  by  the  accelerometers  and  resolved  along  the 
computational  frame  axes  and  ends  with  the  position  and  velocity, 
computed  in  the  local  geographic  frame. 

The  differences  in  navigation  computations  in  both  computa- 
tional frames  for  the  three  types  of  INS  configurations  are  re- 
presented by  the  following  computations: 

1.  Transformation  of  the  velocity  increments  sensed  by 

the  accelerometers  from  the  accelerometers  axes  frame  to 
the  computational  frame.  The  form  of  the  transformation 
matrix  is  a function  of  the  INS  type. 

2.  Computation  of  the  gyro  torquing  signals  is  required  for 
the  INS  with  local-level  stabilized  platform. 

The  attitude  computations,  irrespective  of  the  computational 
frame  used  in  the  navigation  computations,  require  determination 
of  the  transformation  from  the  vehicle  body  axes  frame  to  the 
local-geodetic,  north-pointing  frame. 


For  the  INS  with  a gimballea  platform,  the  gimbal  angles  are 
used  to  compute  the  transformation  from  the  vehicle  body  frame  to 
the  platform  frame.  The  transformation  from  the  platform  frame 
to  the  local-level,  geodetic,  north-pointing  frame  is  determined 
using  the  computed  navigation  parameters.  For  the  strapdown  INS, 
the  transformation  from  the  body  frame  to  the  local-level,  geodetic, 
north-pointing  frame  is  computed  using  the  angular  velocities 
sensed  by  the  gyros  and  the  computed  navigation  parameters. 

Selection  of  the  computational  frame  used  in  the  navigation 
computations  determines  the  format  of  navigation  parameters  com- 
putations required  for  the  attitude  computations. 

3. 3 Frame  Definition 

Definition  of  the  coordinate  frames  employed  in  this  section 
presentation  is  shown  in  Figure  3-2.  The  frames  definition  is 
based  on  the  proposed  standardize  isology  presented  in  Section 
6. 

3.4  Position  and  Velocity  Computations  in  Local-Level  Frame 

Figure  3-3  presents  a block  diagram  of  the  navigation  compu- 
tations of  position  and  velocity  in  the  local-level,  geodetic, 
wander-azimuth  computational  frame.  This  part  of  the  computations 
is  common  for  the  local  level  INS,  the  space  stabilized  INS  and 
for  the  strapdown  INS. 

The  velocity  increments  AV,  sensed  by  the  accelerometers  and 
resolved  along  the  axes  Y2 , 221  are  combined  with  the  V/R  terms 
and  with  the  Coriolis  correction  terms.  The  computed  horizontal 
velocity  is  resolved  through  the  wander  angle,  a,  inco  the  east 
and  the  north  components.  Computation  of  the  vertical  velocity 
component  requires  the  magnitude  of  the  local  gravity.  In  addition, 
the  barometric  altitude,  hg,  is  used  in  a third-order  damping 
loop  to  bound  the  vertical  channel  computation  errors.  The  com- 
puted horizontal  velocity  is  used  in  the  computation  of  the  angular 
rate  2i  °f  the  computational  frame,  2',  with  respect  to  the 
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EARTH'S 
AXIS  OF 
ROTATION 


Z0-Z1 


FRAMES 


X0Y0Z0  s SPACE  STABLIZED  REFERENCE 

X0'Y0'Z0'  = EARTH  FIXED  REFERENCE,  AT  t = 0,0'  FRAME  COINCIDES  WITH  0 FRAME 

X1Y1Z1  = EARTH  FIXED,  FOR  LONGITUDE  X = 0,  1 FRAME  COINCIDES  WITH  0' FRAME 
X2,Y2,Z2  = LOCAL  GEODETIC  UP,  EAST,  NORTH 

X2'«Y2'/Z2'  55  LOCAL  GEODETIC,  WANDER  AZIMUTH,  WANDER  ANGLE  = a 

x5.Y5,Z5  = AIRCRAFT  BODY  Xg  UP,  Yg  ALONG  RIGHT  WING,  Zg  ALONG  FUSELAGE  (FORWARD) 

FOR  ATTITUDE  ANGLES  AND  WANDER  ANGLE  = 0,  THE  5 FRAME  COINCIDES  WITH  THE  2 FRAME 


Figure  3-2.  Definition  of  Axes  Frames 
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earth  fixed  frame,  0 . The  o)n,  is  used  to  uDdate  the  direction 

u ,z0' 

cosine  matrix  of  transformation,  C21.,  between  the  frames  2'  and 

and  O'.  The  updating  is  based  on  solution  of  the  differential 
‘O'  O' 

equation  C 2,  = C 2,  u)q,  • The  latitude,  L,  longitude,  X + w^e, 
and  the  wander  angle,  a,  are  computed  from  the  C2,  matrix  terms. 


Figure  3-4  presents  additional  computations  in  the  1ocal 
level  frame  required  for  an  INS  with  a local  level  platform 
stabilization.  The  gyro  torquing  signals  are  computed  using  the 
C2!  and  the  u>Qt  2<  terms* 


Figure  3-5  presents  additional  computations  in  the  local 
level  frame  required  for  an  INS  with  a space  stabilized  platform. 
The  velocity  increments  AV  sensed  by  the  accelerometers  mounted 
on  the  space  stabilized  platform  are  transformed  from  the  plat- 
form axes  frame,  10,  to  the  computational  frame,  2',  using  the 
updated  directional  cosines  matrix  = C2  cq,co  C10' 


■Figure  3-6  presents  additional  computations  in  the  local 

level  frame  required  for  a strapdown  INS.  The  velocity  increments 

AVr  sensed  by  the  accelerometers  mounted  on  the  aircraft  body 

are  transformed  from  the  body  frame,  5,  to  the  computational 

frame,  2'  using  the  direction  cosines  transformation  matrix, 

2 • 2 ' 

C5  . The  matrix  is  computed  from  the  quaternion,  g.  The 

quaternion,  g,  is  computed  and  updated  using  the  angluar  velocity 
5 5 

^ sensed  by  the  gyros  and  the  angular  velocity  2,  of  the 

computational  frame,  2',  with  respect  to  the  inertial  frame,  0, 

computed  in  the  2'  frame  and  transformed  to  the  5 frame. 


3. 5 Position  and  Velocity  Computations  in  Space-Stabilized 

Frame 

Figure  3-7  presents  a block  diagram  of  the  navigation  com- 
putations in  the  space-stabilized  computational  frame.  This 
part  of  the  computations  is  common  for  the  local  level  INS,  the 
space-stabilized  INS  and  the  strapdown  INS. 

0 

The  velocity  increments,  AV  , sensed  by  the  accelerometers 
and  resolved  along  the  space-stabilized  axes  frame,  0,  and  com- 
bined with  the  gravity  contributions,  £AT  and  with  the  barometric 
damping  term,  K^Ah.  The  computed  inertial  velocity,  V®,  ’ s used 
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to  compute  the  local  geodetic  velocity  components  V , V , V . 

q x2’  1 z2' 

The  Vu  is  also  used  with  the  baromecric  damping  term,  K^Ah,'  in 
the  computations  of  the  local  geodetic  positon,  components  L, 

A,  h.  The  R.^is  also  used  in  the  gravity  computations  and  in 
the  geodetic  velocity  computations. 

Figure  3-8  presents  additional  computations  in  the  space- 
stabilized  frame  required  for  an  INS  with  a local  level  stabil- 
ized platform.  The  velocity  increments,  AV IQ,  sensed  by  the 
accelerometers  mounted  on  the  platform  are  transformed  from  the 

platform  frame,  10,  to  the  space-stabilized  computational  frame, 

0 o o ' 1 2 

0,  using  the  updated  directional  cosines  matrix,  = C0,C1  C2  C10 

In  addition,  the  required  gyro  torquing  signals  are  computed. 

Figure  3-9  presents  additional  computations  in  the  space- 

stabilized  frame  required  for  an  INS  with  a space  stabilized  INS. 

The  velocity  increments,  AV^O,  sensed  by  the  accelerometers 

mounted  on  the  space  stabilized  platform,  are  transformed  to  the 

space  stabilized  axes  frame,  0,  using  a constant  transformation 
0 


matrix  C 


10- 


Figure  3-10  presents  additional  computations  in  space- 
stabilized  frame  required  for  a strapdown  INS.  The  velocity  in- 
crements AV5  sensed  by  the  accelerometers  mounted  on  the  aircraft 
body  are  transformed  from  the  body  axes  frame  to  the  computa- 
tional frame  using  the  direction  cosine  transformation  matrix  C^. 

0 -* 
The  matrix  C_  is  computed  from  the  quartenion,  g.  The  quartneion 

3 5 

is  computed  and  updated  using  the  angular  velocity  w r sensed 
by  the  gyros. 


3. 6 Attitude  Computations 

Figures  3-11,  3-12,  3-13  present  block  diagrams  of  the 
aircraft  attitude  computations  used  either  with  the  local-level 
computational  frame  or  with  the  space-stabilized  computational 
frame.  The  attitude  angles  are  computed  by  solving  the  follow- 
ing matrix  equation: 

Attitude  angles  matrix  = Transformation  matrix  from  the 

aircraft  body  axes  to  the  computation 

,2' 


frame  C 


5 ' 
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The  attitude  angles  matrix  is  a function  of  the  aircraft 

roll,  pitch  and  a sum  of  yaw  and  wander  angles.  Th;  transformation 
2 ' 

matrix,  , for  the  gimballed  type  of  the  INS,  with  either  the 
local-level  (Figure  3-11)  or  the  spac e-s tan i i i ?t:d  platform  (Fig- 
ure 3-12)  consists  of  the  transformation  from  she  aircraft  body 
axes  frame  to  the  platform  axes  frame  followed  by  uho  transfor- 
mation from  the  platform  frame  to  the  computational  frame.  The 
first  matrix  is  computed  from  the  gimbal  angles  and  ti e second 
matrix  is  obtained  from  the  navigation  computations  shown  in 
Figures  3-3,  3-5,  3-7,  3-8. 

For  the  strapdown  INS  (Figure  3-13)  the  tram nation  from 

the  body  axes  frame,  5,  to  the  local,  wander-azimuth  computational 

frame,  2',  is  obtained  using  the  angular  body  rates  with  respect 

to  the  inertial  frame,  sensed  by  the  strapdown  gyros.  and 

the  angular  rate  of  the  computational  frame  with  respect  to  the 
2 ' 

inertial  frame,  2>  > obtained  from  the  navigation  computations. 
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SURVEY  OK  SOFTWARE  INTERFACES 


4. 1 Introduction 

A survey  of  software  interfaces  between  the  INS  navigation 
computations  and  other  avionic  system  computations  was  performed 
to  obtain  technical  data  required  for  design  of  the  computer 
errors  simulation  program,  described  in  Volume  III  of  this  report. 
The  survey  results  were  used  to  obtain  the  following  data, 

a.  The  accuracy,  the  resolution  and  the  data  rate  of  the 
inertially  sensed  data  required  for  the  avionic  compu- 
tations. 

b.  The  characteristics  of  the  navigation  aids  measurements 
used  in  the  INS  navigation  computations  updating. 

The  following  avionic  computations  are  included  in  this 
surveys 

a.  A-7D  INS  Weapon  Delivery  and  Flight  Control  Computations 

b.  A-7D  INS  Navigation  Displays 

c.  A-7D  INS  Air  Data  Computations 

d.  C-5  INS  Navigation  Computations  Updating 

e.  Electronically  Agile  Radar  (EAR)  Radar  Antenna  Motion 
Compensation  Computations 

The  surveyed  documentation  was  limited  to  the  reports  on 
file  at  CSDL  at  this  time.  The  results  of  the  survey  are  pre- 
sented in  Tables  4-1  to  4-7. 

4.2  Summary  and  Conclusions 

A survey  of  the  software  interfaces  between  the  INS  naviga- 
tion computations  and  avionic  systems  computations  summarized  in 
Table  4-1,  revealed  typical  accuracy,  resolution  and  data  rate  of 
the  inertially  sensed  data  required  for  the  avionic  systems 
computations. 


4-1 


Table  4-1  Survey  Summary  of  INS  Software  Interfaces 
With  Avionic  Computations 
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The  inertially  sensed  data  consists  of  linear  acceleration, 
attitude  and  possible  attitude  rate.  The  velocity  and  position 
are  derived  from  the  inertially  sensed  data.  The  linear  accelera- 
tion, data  sensed  by  the  accelerometers  is  in  the  form  of  pulses 
representing  velocity  increments.  The  attitude  data  is  obtained 
from  the  gimbal  angle  readouts.  The  attitude  rate  data  is  ob- 
tained either  by  differentiation  of  the  attitude  data  oi  it  is 
sensed  directly  by  the  body  mounted  (strapdown)  rate  gyros. 

The  survey  results  indicate  that  severe  resolution  and  rate 
requirements  for  the  linear  acceleration  and  the  attitude  data 
are  imposed  by  the  antenna  motion  compensation  computations  em- 
ployed in  the  synthetic  aperture  radar  operation  (SAR) , as  shown 
in  Table  4-1.  The  required  velocity  increments  resolution  is 
0.00125  ft/sec  with  a data  rate  of  256  Hz  for  the  acceleration 
range  of  +2g.  The  required  level  indication  resolution  is  40  arc- 
sec  (la) ; the  required  azimuth  resolution  is  2 arc-min  (la)  and 
the  required  rate  of  the  attitude  data  is  256  Hz.  The  data  rate 
requirements  are  met  by  interpolating  the  inertial  sensor  data 
between  8 Hz  navigation  computation  updates. 

The  A-7D  navigation  computations  require  a 0.032  ft/sec  resolu- 
tion of  the  velocity  increments  with  a data  rate  of  5 Hz  for  an 
acceleration  range  of  10  ^g  to  lOg. 

The  A-7D  weapon  delivery  computations  require  the  velocity 
increment  data  in  the  navigation  frame  with  a data  rate  of  25  Hz. 

The  required  attitude  resolution  is  2 arc-min  (la)  with  a data 
rate  of  25  Hz. 
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The  A-7D  flight  control  computations  require  velocity  in- 
crement data  in  the  aircraft  body  frame  with  a data  rate  of  50  Hz 

_2 

to  100  Hz  for  an  acceleration  range  10  g to  lOg. 

The  A-7D  navigation  computations  data  requirements  are 
sufficient  for  the  display  computations. 


The  A-7D  inertially  sensed  data  requirements  are  shown  in 
Table  4-2. 
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The  A-7D  INS  navigation  computations  use  barometric  altitude 
data  to  stabilize  the  vertical  channel  computations.  The  air  data 
computer  (ADC)  is  used  to  generate  the  barometric  altitude  data, 
the  true  and  the  indicated  air  speed  data  and  the  Mach  number 
data.  The  true  air  speed  data  is  used  in  computation  of  the  wind 
velocity.  The  indicated  air  speed  »_^ta  is  used  for  the  head  up 
display  (HUD) . The  Mach  number  is  used  in  the  weapon  delivery 
and  in  the  automatic  flight  control  computations.  The  air  data 
range,  accuracy  and  resolution  are  shown  in  Table  4-5. 

A survey  of  the  navigation  computations  updating  by  the 
navigation  aids  employed  in  C-5  INS  indicates  that  the  Kalman 
filter  computations  require  2200  words  of  28  bits.  The  computa- 
tions employ  floating-point  arithmetic  with  28  bit  words  shared 
equally  by  mantissa  and  exponent.  The  sampling  rate  of  the 
measurements  is  of  the  order  of  one  sample  per  second  and  the 
Kalman  filter  updating  cycle  is  of  the  order  of  minutes.  The 
measurements  samples  are  averaged  over  the  Kalman  computational 
cycle.  The  navigation  aids  measurements  provide  an  update  of  the 
computed  position,  velocity  and  at'titude.  The  measurements  are 
also  used  to  update  the  three  gyro  biases,  the  vertical  acceler- 
ometer bias,  the  dopp.ler  radar  measured  drift  angle,  the  computed 
ground  speed  scale  factor  and  the  barometric  altimeter  bias. 

The  range  and  accuracy  of  the  typical  navigation  aids  mea- 
surements employed  in  the  aircraft  navigation  computations  (not 
necessary  in  the  C-5  INS)  are  shown  in  Table  4-6. 
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The  weapon  delivery  and  aircraft  flight 
require  the  following  inertially  derived  data: 

control  computations 

a. 

Linear  Acceleration 

b. 

Velocity 

c. 

Position 

d. 

Attitude 

e . 

Attitude 

Rate 

The 

tion,  the 

inertial 

attitude 

instruments  sense  directly 

and  the  attitude  rate.  The 

the  linear  accelera- 

inertially  sensed 

data  is  used  to  compute  the  velocity  and  the  position.  In  soiw 
applications  the  attitude  rate  may  be  computed  from  the  sens'."1 
attitude.  In  A-7D  INS  the  attitude  rate  (the  aircraft  body  a) 
is  obtained  in  analog  form  from  the  strapdown  (body  mounted)  rate 
gyros. 

Table  4-2  presents  the  range,  the  resolution  and  the  rate 
of  the  inertially  sensed  data  required  for  the  A-7D  weapon 
delivery  and  for  the  flight  control  computations. 

4.3.1  Attitude  Data 

In  A-7D  INS  the  vehicle  attitude  is  obtained  from  the  gimbal 
angles  measurements,  providing  the  aircraft  pitch,  roll  and  yaw  in 
relation  to  the  geodetic  local-level,  north-pointing  reference 
frame.  The  angle  data  is  read  out  by  synchros  with  2 arc-min  (rms) 
accuracy  and  it  is  used  either  directly  or  after  A/D  conversion 
in  the  avionic  system  computations.  The  attitude  data  is  measured 
for  the  aircraft  attitude  changes  up  to  30  deg/sec  in  pitch  and 
yaw  and  up  to  200  deg/sec  in  roll.  To  prevent  an  excessive  mea- 
surement error,  the  attitude  data  sampling  rate  25  samples/ 

sec  is  used.  A summary  of  the  typical  attitude  data  utilization 

“ (17) 

in  A-7D  avionic  systems  is  shown  in  Table  4-3 
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Table  4-2  Avionic  Systems  Use  of  Inertially  Derived  Data 
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Table  4-3  Typical  Attitude  Data  Utilization 

1 17 ) 

in  A-7D  Avionic  Computations' 


MEASUREMENT  OR 
COMPUTATION 

APPLICATION 

MEASUREMENTS 

REQUIRED 

DATA 

RATE 

NAV  Frame  to  Body  Frame 
Transformation 

Target  LOS  Components  transform 

• All  Bombing  Modes 

"mpact  Point  Components  transfor- 
mation 

<*  Air-to-Gnd  Gun/Rocket  Mode 
<*  I'oi  ib  Fall  Line 

Gun  Line  Aim  Angle  Transformation 

• A!r-to-Air  Gun/Rocket  Mode 

FPM 

• Velocity  Components 
Transform 

Target  El,  Az  Angle  Transform 

• ITV  Bombing 

• FLIR  Bombing 

Pitch,  Roll,  Yaw 

25 

25 

25 

25 

Body  Frame  to  NAV  Frame 
Transformation 

Target  LOS  Angle  Transformation 

• FLIR  Bombing 

• ITV  Bombing 

Reticle  El,  Az  Angle  Transformation 

• Visual  Attack  Bombing  Mode 

• Visual  Attack  Offset  B M 

Pitch,  Roll,  Yaw 

25 

* 

Target  LOS  El  Rate,  Az  Rate 
in  Body  Frame 

Body  Rate  Compensation  of  FLIR 
and  ITV 

Pitch,  Roll,  Yaw 

25 

G Vector  WRT  Body  Frame 

Weapons  delivery  Computation 

Pitch,  Roll,  Yaw 

25 

Sin  & Cos  of  Roll 

HUD  display  attitude  positioning 

Roll 

Pitch  Angle 

Pitch  word  to  HUD 

Pitch 

25 

Roll,  Pitch  Attitude 

• Attitude  Indication  for  VSD  (ADI) 

• Pitch  and  lateral  steering 
commands  from  Flight  Director 
Computer  (FDC) 

Roll,  Pitch 

* 

Pitch,  Roll  Error  Commands 

FCS  attitude  hold  error  commands 
for  autopilot 

Pitch,  Roll 

* 

Heading 

Steering  Commands  for  VSD,  HSD, 
HUD 

Pitch,  Roll,  Yaw 

* 

Attitude 

FCS  attitude  compensation 
calculations 

Pitch,  Roll,  Yaw 

* 

•ANALOG  data 
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4,3.2  Attitude  Rate  Data 


In  A-7D  the  aircraft  attitude  rate  data  is  obtained  from 
the  strapdown  gyros  that  are  a part  of  the  Flight  Control  System 
(FCS) . The  data  is  in  analog  form  with  15  to  30  Hz  bandwidth. 
Resolution  of  the  pitch  and  yaw  rate  gyros  data  is  j.01  deg/sec 
and  resolution  of  t.he  roll  gyro  data  is  0.05  deg/sec.  The 
FCS  computations  including  the  computations  for  the  pitch 
and  roll  axes  Control  Augmentation  System  (CAS)  and  the 
yaw  axis  Stability  Augmentation  System  (SAS)  are  the  principal 
users  of  the  attitude  rate  data.  Outside  the  FCS  the  attitude 
rate  data  is  required  for  the  Forward-Looking  Radar  (FLR)  compu- 
tations when  operating  in  terrain- following  or  terrain-avoidance 
mode.  The  atittude  rate  data  is  used  to  obtain  the  turn  rate 
information  for  offset  of  the  azimuth  pointing  of  the  radar 
antenna  during  the  turn  to  indicate  to  the  pilot  where  he  is 
going.  The  turn  rate  is  also  displayed  on  the  Attitude  Director 
Indicator  (ADI) . The  aircraft  pitch  and  yaw  rates  could  be  also 
used  in  computation  of  gun-line  lead  angle  for  air-to-air  weapon 
'■'.eiivery  at  fixed  range  using  a servoed  aiming  vehicle  which  the 
pilot  maintains  on  target. 

A summary  of  the  representative  type  of  the  avionic  compu- 
tations utilizing  the  attitude  rate  data  is  shown  in  Table  4-4 

4.3.3  Linear  Acceleration  Para 

The  linear  acceleration  (specific  force)  is  sensed  by  the 
torque-restrained,  pendulum  type  accelerometers,  mounted  on  the 
IMU  platform.  The  acceleromeuer  output  pulses  represent  velocity 
increments  at  0.032  ft/sec/pulse  (low-gain  scaling,  used  during 

the  flight) . The  overall  specific  forces  range  sensed  by  the 

-4 

accelerometers  is  from  10  g tc  lOg.  The  required  data  rates  are 
5 Hz  for  the  navigation  computations,  25  Hz  for  the  weapon  delivery 
computations  and  50  Hz  to  100  Hz  for  the  FCS  computations. 
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Table  4-4  Typical  Attitude  Rate  Data  Utilization 

11 7) 

m A-7D  Avionic  Computations ' 


Measurement  or 
Computation 


Application 


Data  Form 
Required 


DATA 

RATE 

(Samples/sec) 


Bouy  P.-ch  Rate 


Body  Roll  Rate 


FCS:  Pitch  axis  CAS 


Body  pitch  rate 


*BW.  15-30  cps 


FCS:  Roll  axis  CAS 


Body  roll  rate 


*BW.  15-30  cps 


Body  Yaw  Rate 


FCS:  Yaw  axis  SAS 


Body  /aw  rate 


'BW-  15-30  cps 


Turn  Rate 


FLR  offset  azimuth 
pointing  during  turn 


Body  yaw  rate 


25 


Turn 


Aiming  Lead  Angle 


''SD  indication 


Body  yaw  rate 


Gun-Line  Lead  angle 


Body  pitch  & 
yaw  rate 


25 


Body  attitude  Rate 
Compensation 


Rate-aided  FLR  attitude 
stabilization 


Platform  Pitch 
Gimbal  Rate; 
Platform  Roll 
Gimbal  Rate 
or 

Body  i uch  rate 
Body  Yaw  rate 


Body  attitude  Rate 
Compensation 


Rate-aiued  boiesigiit 
stabilization  for  FLIR 
and  !TV 


Body  pitch  late 
Body  yaw  late 


ANALOG  DATA 


In  the  A-7D,  acceleration  data  for  navigation  functions  is 
accumul.ated  and  corrected  for  Coriolis , centripetal/  and 
gravity  accelerations  to  yield  a high-accuracy  velocity  update 
five  times  a second.  The  weapon  delivery  calculations/  however/ 
require  moie  frequent  velocity  information.  To  satisfy  this 
latter  requirement/  the  raw  accelerometer  data  is  sailed  25  times 
a second,  it  is  corrected  for  gravity  acceleration  and  it  is  added 
incrementally  to  the  latest  velocity  update,  thus  providing  five 
velocity  interpolations  between  each  navigation  velocity  update. 

For  the  FCS  computations  the  acceleration  data  is  sampled 
at  a 50  to  100  samples  per  second  rate  and  it  is  tranformed  from 
the  platform  frame  to  the  aircraft  body  frame. 

4 . 4 A-7D  Navigation  Displays  Computations 

The  following  major  navigation  displays  are  employed  in 

A-7D: 

1.  Attitude  Director  Indicator  (ADI) 

2.  Horizontal  Situation  Indicator  (HSI) 

3.  Head-up  Display  (HUD) 

4.  Forward  Looking  Radar  (FLR) 

5.  Projector  Map  Display  System  (PMDS) 

A listing  of  parameters  presented  in  each  display  is  given 

below 

ADI 

Roll,  Pitch  Attitude 
Magnetic  Heading 

Horizontal,  Vertical  S toering  Pointers 
Displacement  Pointer 
Slip  Indication 
Rate-of-turn  Indicator 
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HSI 

Range  Display 
Compass  Card 
Settable  Heading  Marker 

Course  Pointer  and  Settable  Digital  Course  Readout 
To  - From  Arrow 
Course  Deviation  Bar 


HUD 

Flight  Path  Angle,  Marker 
Horizon  Line 
Angle-of -attack 
Pull  Up  Command 
Airspeed 

Altitude/Vert  Velocity 
Radar  Altitude  Advisory  Symbol 
Magnetic  Heading 
Flight  Director 
Landing  Director 

Terrain  Following  Pitch  Steering  Commands 
Drift  Angle 
ci  ide  Slope  Deviation 
lizer  Deviation 

FLR 

5"  CRT  Sector  Display 
Adjustable  Cursor  for  NAV  Marks 

Projected  Map  Display 

5"  Projected  Siewable  Map  Sector  Display 

Present  Position 

Magnetic  Track  Angle 

Bearing  to  Destination 

Range  to  Destination 

Landmark  Update  Capability 
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The  accuracy,  the  resolution  and  the  data  rate  of  the 
inertially  derived  parameters  required  for  the  navigation  and  the 
weapon  delivery  computations  are  adequate  for  the  navigation 
displays. 

4.5  A-7D  Air  Data  Computations 

The  A-7D  air  data  computer  (ADC) , CP-953A/AJQ  uses  the 
sensed  static  pressure,  the  ram  pressure  and  the  free  air  tempera- 
ture to  compute  the  true  air  speed,  the  indicated  air  speed,  the 
Mach  number  and  the  barometric  attitude. 

The  true  air  speed  is  used  with  the  inertially  derived 
velocity,  heading,  attitude  and  with  the  angle  of  attack  (AOA) 
from  the  AOA  transducer  in  computa  .ion  of  the  wind  velocity.  The 
computed  wind  velocity  is  stored  for  use  in  the  weapon  delivery 
computations,  in  the  degraded  navigation  modes  of  operation  and  it 
is  displayed  for  the  pilot. 

The  indicated  air  speed  is  used  for  the  pilot  head-up  dis- 
play (HUD)  . 

The  Mach  number  is  used  in  the  weapon  delivery  computations 
and  in  the  automatic  flight  control  computations. 

The  barometric  altitude  is  used  primarily  to  stabilize  the 
vertical  channel  inertial  navigation  computations.  In  addition, 
the  barometric  altitude  is  used  in  computations  employed  in  FLR 
(in  the  sweep  delay  correction  for  the  ground  map  use) , in  AFCS 
(in  attitude  hold  computations) , in  IF^SIF  (in  altitude  reporting) 
and  in  AAU-19/A  altimeter  (in  pilot  readout) . 

Table  4-5  presents  a 1:  st  of  the  ADC  derived  data  including 
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the  range,  the  accuracy,  the  resolution  and  the  data  format  ' . 


Ba 


4.6  C-5  INS  Navigation  Computations  Updating 


The  C-5  Kalman  Navigation/Alignment  Mechanization  is  shown 

(19) 

in  functional  block  diagram  , Figure  4-1.  The  INS  computa- 

tions are  updated  by  the  navigation  and  measurements  using  Kalman 
filter.  The  updating  provides  corrections  to  the  following  data: 

Position  (2) 

Velocity  (2) 

Altitude  Rate  (1) 

Altitude  (1) 

Computed  Heading  (1) 

Platform  Leveling  Rates  (2) 

Gyro  Biases  (3) 

Vertical  Accelerometer  (1) 

Doppler  Drift  Angle  (1) 

Ground  Speed  Scale  Factor  (1) 

Barometric  Altitude  (1) 

The  numbers  in  brackets  shown  above  indicate  the  number  of 
components  updated  by  the  Kalman  filter  computations. 

The  total  number  of  updated  variables  (state  variables)  is 
sixteen . 

The  following  navigation  aids  are  employed  in  the  updat- 
(19) 

mgs 

1.  Doppler  Radar 

2.  Loran  Receiver 

3.  Tacan  Receiver 

4.  Multimode  Radar 

5.  Position  Fix 

6.  Barometric  Altimeter 
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• The  Doppler  radar,  manufactured  by  the  GPL  Division  of 
General  Precision  Systems,  Inc,,  supplies  the  computer  with  mea- 
surements of  ground  speed  and  drift  angle.  By  utilizing  the  in- 
formation from  the  ball  readout,  it  is  possible  to  obtain  the 
ground  speed  relative  to  platform  axes. 

• The  Loran  recoiver  is  manufactured  by  Collins  Radio  Company. 
When  available,  Loran  data  is  converted  in  digital  computer  to 
provide  position  information  displayed  to  the  navigator.  Subject  to 
the  navigator's  judgment  and  control,  the  Loran  data  can  also  be 
used  to  update  the  best  estimate  of  the  state  vector  which  in- 
cludes position,  velocity,  and  other  quantities. 

• The  Tacan  receivers,  manufactured  by  Hoffman  Electronics, 
provide  slant  range  and  bearing  information  to  ground  stations 

at  known  locations.  The  navigator  can  use  this  data,  when  avail- 
able, in  a manner  similar  to  that  described  for  the  Loran. 

• The  multimode  radar  (MMR) , manufactured  by  Norden  Division 
of  United  Aircraft,  provides  many  modes  of  operation  for  the  C-5. 

Two  modes  are  used  t * obtain  navigation  information.  In  the 
terminal  phase  of  flight,  the  navigator  can,  through  a cathode 
ray  tube  display,  sight  on  landmark  patterns  whose  position  rela- 
tive to  the  desired  supply  and/or  personnel  drop  location  is  known. 
Slant  range  and  bearing  data  is  provided  by  the  MMR  during  the 
terminal  phase.  The  navigator  can  also  use  the  MMR  for  sighting 
on  landmarks  whose  absolute  position  (latitude  and  longitude)  are 
known.  In  this  mode,  measurements  of  range,  bearing  and  landmark 
location  go  directly  to  the  Kalman  filter. 

• Position  fix  data  are  available  from  Loran,  Tacan,  multimode 
radar,  visual  updates  and  celestial  fixes.  When  the  operator  re- 
quests position  fix  data  from  Tacan,  for  exaple,  the  Tacan  routine 
processes  the  receiver's  slant-range  and  bearing  information  into 
craft  position.  Differences  between  the  system's  best  estimate  of 
craft  position  and  the  Tacan  determined  craft  position  are  computed 
and  displayed  to  the  operator  along  the  Tacan  determined  position 
and  a suitable  radial  position  difference.  In  addition,  a statis- 
tical reasonableness  test  is  performed  on  each  of  the  Tacan  mea- 
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surements,  and  the  operator  is  informed  of  the  results.  If  the 
processor  finds  the  fix  to  be  reasonable,  the  operator  may  accept 
it  (FIX  ENABLE)  or  reject  it  (FIX  REJECT) . If  the  processor  finds 
the  fix  to  be  unreasonable,  the  operator  may  reject  it  or  over- 
ride it  (FIX  OVERRIDE) . This  same  procedure  is  followed  when  the 
operator  requests  data  from  the  Loran,  multimode  radar,  visual 
fixes  or  celestial  fixes. 

• The  barometric  altimeter  is  a part  of  the  two  ail  data  com- 
puter (CADC)  manufactured  by  Elliot  Brothers.  The  barometric 
pressure  altitude  data  is  used  in  the  navigational  computations. 

• Kalman  filter  computations  are  mechanized  on  NDC-1051A 
digital  computer,  manufactured  by  Northrop  Electronics  Division. 
The  sampling  rate  of  the  navigation  aids  measurements  is  of  the 
order  of  one  sample  per  second  and  a typical  Kalman  computation 
updating  cycle  is  of  the  order  of  a few  minutes.  The  measurements 
samples  are  averaged  ever  the  Kalman  computation  cycle.  The  com- 
putations employ  floating-point  arithmetic  utilizing  28-bit  word 
shared  equally  by  mantissa  and  exponent  with  2200-words  alloca- 
tion. 

The  range  and  accuracy  of  typical  navigation  aids  measure- 
ments employed  in  the  aircraft  navigation  (not  necessarily  in  C-5) 
are  shown  ir  Table  4-6^2^  . 
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Table  4-6  Typical  Characteristics  of  Navigation 
Aids  Measurements 


AN  AIDED 
INS 
(C-5) 


AVIONIC 

SYSTEM 

TYPE 


DOPPLER 

RADAR 


LORAN  C 
RECEIVER 
LORAN  D 
RECEIVER 


TACAN 

RECEIVER 


MULTI 

MODE 

RADAR 


POSITION 

FIX 


BARO- 

METRIC 

ALTIMETER 


AVIONIC 

SYSTEM 

DERIVED 

DATA 


DRIFT 

ANGLE 


GROUND 

SPEEO 


AIRCRAFT 

POSITION 


SLANT  RANGE 
TO  TACAN 
STATION 


BEARING  TO 

TACAN 

STATION 


SLANT  RANGE 
TO  KNOWN 
POINT 


BEARING  TO 
KNOWN  POINT 

LATITUDE 

LONGITUDE 


BAROMETRIC 

ALTITUDE 


INERTIAL 

SYSTEM 

NAVIGATION 

APPLICATION 


TYPICAL  NAV-AIDS 
MEASUREMENTS 
CHARACTERISTICS 


REFERENCE 


S 5 

„ OJ  ^ 

^ cc  z 

ll/  ri  5r 

r c:  o 

58*= 

Z o w 

59  a 

<1-01 

2 = 
s 
o 
o 


RANGE 

ACCURACY  (10) 

30  DEG 

0.1  DEG 

20 

100  TO 

1000 

KNOTS 

0.1%  + 

0.1  KNOT 

MAJOR 

SHIPPING 

LANES 

350  FT 

21 

300n 

600  FT 

MILES 

1 DEG 

-1000 

5 FT  OR  0.05% 

TO 

50,000  FT 

OF  ALTITUDE 

4 . 7 SAR  Antenna  Motion  Compensation 

The  Synthetic  Aperture  Radar  (SAR) , used  for  mapping  to  the 
side  of  the  aircraft,  is  a part  of  the  Electronically  Agile  Radar 
(EAR) . The  required  mapping  azimuth  resolution  is  obtained  in 
SAR  mapping  by  generation  of  an  effective  long  antenna  derived 
from  signal  processing  means  rather  than  from  the  actual  use  of  a 
long  physical  antenna.  In  SAR  a radiating  element,  translated  with 
the  aircraft,  assumes  sequential  positions  along  a line.  At  each 
of  these  positions  a signal  is  transmitted  and  the  amplitude  and 
phase  of  the  radar  signals  reflected  from  the  terrain  are  stored. 
After  the  radiating  element  transversed  a predetermined  distance, 
equal  to  the  effective  length  of  the  antenna,  the  stored  signals 
resemble  strongly  the  signals  that  would  have  been  received  by 
the*  elements  of  an  actual  linear  array  with  the  same  effective 
antenna  length.  Consequently,  the  effect  of  a long  physical 
linear  antenna  array  is  achieved  by  a single  moving  radiating 
element. 

An  uncompensated  motion  of  the  SAR  antenna  during  the  map- 
ping time  interval  is  introducing  phase  errors  in  the  stored 
radar  signals.  The  resultant  range  errors  are  directly  propor- 
tional to  the  phase  errors. 

The  SAR  antenna  motion  may  be  sensed  by  an  IMU,  hard- 
mounted  on  the  antenna.  Two  possible  IMU  configurations  employed 
for  the  antenna  motion  compensation  are  as  follows: 

1.  A high  quality  master  IMU  mounted  directly  on  the 
antenna. 

2.  A less  accurate,  slave  IMU  mounted  on  the  antenna  and 
a high  quality  master  IMU  mounted  approximately  1 meter 
away. 

The  antenna-mounted  IMU  performance  required  for  the  SAR 
antenna  motion  compensation  is  listed  in  Table  4-7. 


mmzsm 


The  listed  accuracy,  resolution  and  rate  of  the  inertial 

data  is  required  to  meet  the  present  design  criteria  for  the 
(22) 

— assumptions  used  in  developing  this  specification 


SAR 
are : 


the 


1.  The  IMU  is  hard  mounted  to  the  antenna  and  the  antenna 
is  hard  mounted  to  the  aircraft. 


2.  B-l  aircraft  environment  with  a 2 g maneuver  and  angu- 
lar rates  of  20  deg/sec. 


3.  Mapping  range  50  n miles,  the  antenna  squi.it  angle  20 
deg,  the  aircraft  velocity  600  ft/sec. 


4.  Hamming  weighting  the  Peak  Side  Lobe  Ratic  (PSLR)  is 
below  -30dB . the  Strehl  intensity  is  larger  t)  m 0.8  and  the 
flare  ratio  ^used  in  specifcation  of  the  averac  ' clutter)  is 
0.1. 
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SECTION  5 


SELECTION  OF  COMPUm'  ..IONAL  FRAME 
FOR  THE 

COMPUTER  ERRORS  SIMULATION  PROGRAM 


The  INS  navigation  computations  may  be  pei formed  in  either 
the  local-level  or  the  space-stabilized  frame. 

The  criteria  used  in  the  selection  of  the  computational 
frame  for  the  computer  errors  simulation  program  are  as  follows: 

1.  World-wide  navigation  computations  capability. 

2.  Maximum  commonality  in  the  navigation  computations  for 
the  INS  with  a local-level  stabilized  platform,  a space 
stabilized  platform  and  a strapdown  configuration. 

3.  Minimum  of  required  computer  complexity. 

4.  Simple  interface  with  the  avionic  systems'  computations 
including  the  computations  used  for  the  flight  control, 
weapon  delivery,  and  the  radar  antenna  motion  compensation. 
Simple  interface  with  the  navigation  aid  measurements  data. 

The  local-level,  geodetic  wander-azimuth  frame  was  selected 
as  a computational  frame  for  the  INS  computer  errors  simulation 
program.  The  frame  selection  was  dictated  primarily  by  the  sim- 
pler computation  format  for  the  INS  with  a local-level  stabilized 
platform  and  simpler  software  interfaces  with  most  avionics  compu- 
tations and  navigation-aid  measure,  tents . Computations  in  the 
space-stabilized  frame  are,  however,  somewhat  simpler  for  the 
space-stabilized  and  strapdown  INS. 

Comparison  of  the  local-level  and  the  sp_  c-'  - stabilized  com- 
putational frames  characteristics  is  summarized  in  Table  5-1. 
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Table  5-1.  Comparison  of  Local-Level  and  Space-Stabilized 

Computational  Frames 


COMPUTATIONAL  FRAME  CHARACTERISTICS 


SELECTION  CRITERIA 

LOCAL-LEVEL 

SPACE-STABILIZED 

World-Wide 

Navigation 

Requires  Wander- 
Azimuth,  Free-A2i- 
muth,  Unipolar,  or 
Inverse  Coordinates 

No  Added  Requirements 

Commonality  of  Computations 

Required  Additional 
Transformations  in 
Attitude  Computations 
for  Space-Stabilizec, 
and  Strapdown  INS 

See  ’ Jirtional  Trans- 
formations Required 

Complexity  of  Computations 

Siirpler  Computations 
for  Local-Level  INS 

Simpler  Confutations 
for  Space-Stabilized 
and  Strapdown  INS 

Interface  with  Other  Avionic 
Computations 

1 

— 

Simpler  Interface 
with  Most  Avionics 
anu  Navigation  Aids 
Computations 

Simpler  Interface  with 
Some  (Star  Tracker) 
Navigation  Aids  Compu- 
tations 

The  remaining  part  of  this  section  contains  a discussion  of 
the  frame  selection  criteria  listed  above. 

1.  World-wide  Navigation  Capability.  Near  the  earth's 
poles,  latitude-longitude  poor  navigation  coordinates 
because  of  the  convergence  of  meridians.  This  effect  re- 
sults in  both  mechanical  and  computational  difficulties  in 
the  implementation  of  the  local-level  platform  stabiliza- 
tion. For  the  INS  with  the  north-pointing  platform  stabi- 
lization operating  near  the  polar  region,  the  required 
azimuth  gyro  torquing  rate  becomes  excessive  and  the  compu- 
tation of  certain  latitude  functions  and  longitude  rate  have 
singularities  at  the  poles. 

These  difficulties  could  be  removed  by  the  use  of  modified 
local-level  coordinates  for  the  platform  stabilization  frame 
and  for  the  navigation  computational  frame.  Various  modi- 
fied local-level  frames  employ  the  wander-azimuth,  the  free- 
azimuth,  the  unipoloar,  and  the  inverse  coordinates. 


5-2 


The  navigation  computations  in  the  wander-azimuth  frame, 
selected  for  this  simulation  program,  determine  the  INS 
positiosii  and  velocity  in  the  latitude-longitude  coordinates. 
While  the  wander-azimuth  frame  computations  eliminate  the 
problems  encountered  in  the  computations  utilizing  the  local- 
level  north-pointing  frame,  the  use  of  latitude-longitude 
coordinates  for  the  polar  region  navigation  is  not  the  best 
choice. 

The  navigation  computations  in  the  space- stabilized  frame 
determine  the  INS  position  and  velocity  in  the  space-stabi- 
lized coordinates.  The  computed  position  and  velocity  can 
be  then  resolved  in  any  desired  frame  (for  example  along  the 
track,  cross  track  and  altitude  directions) . 

2 • Maximum  Commonality  of  the  Navigation  Computations.  The 
commonality  of  computations  for  both  computational  frames 
n tarts  from  processing  of  the  velocity  increments  sensed  by 
the  accelerometers  and  resolved  in  the  computational  frame 
axes  and  ends  with  the  computed  po»ition  and  velocity  re- 
solved in  the  desired  coordinates,  as  shown  in  Figures  3-3 
and  3-7. 

The  aircraft  attitude  computations  have  the  same  format  for 
either  of  the  computational  frames,  as  shown  in  Figures  3-11, 
3-12,  and  3-13.  However,  for  the  computations  in  the  local- 
level  wander-azimuth  computational  frame,  additional  trans- 
formations are  required  for  either  the  space  stable  or  the 
strapdown  INS  due  to  the  absence  of  the  inertial  frame  and 
the  inclusion  of  the  wandor  angle. 

3.  Minimum  of  Required  Computer  Complexity.  For  the  INS 
with  a local-level  stabilized  platform  the  navigation  com- 
putations in  the  local-level  frames  are  somewhat  simpler 
than  the  navigation  computations  in  the  space-stabilised 
frame. 
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For  the  INS  with  a space-stabilized  platform  and  for  the 
strapdown  INS,  the  navigation  computations  in  the  space- 
stabilized  frame  are  considerably  simpler  than  the  naviga- 
tion computations  in  the  local-level  frame. 

4 . Simpler  Interface  with  the  Avionic  System  Computations 
and  with  the  Navigation  Aids  Measurements.  The  navigation 
computations  in  the  local-level  wander-azimuth  frame  have 
somewhat  simpler  interface  with  some  avionic  system  computa- 
tions and  with  the  navigation  aids  measurements  than  the 
navigation  computations  in  the  space-stabilized  frame. 


6.0  SELECTION  OF  STANDARDIZED  FRAMES  SYMBOLOGY. 


6.1  INTRODUCTION 

This  section  presents  a proposed  standardized  symbology  of 
the  coordinate  frames  and  the  frames  transformations  employed 
during  the  INS  navigation  computations.  It  is  recognized  that 
the  proposed  standardization  is  somewhat  arbitrary  and  incom- 
plete, but  it  represents  a reasonable  simple  and  consistent 
sets  of  symbols  and  definitions  of  frame  axes  orientations.  The 

proposed  coordinate  frames  symbology  is  based  on  terminology 

(2) 

employed  by  Honeywell  in  GEANS  studies  and  the  proposed  trans- 
formation frames  symbology  is  based  on  Britting  notation ^ 15 ^ . A 
tutorial  discussion  of  transformation  of  coordinates,  described 
in  Appendix  A,  is  used  a cd  ci  backgrou  nd  for  the  material  pre- 
sented in  this  section. 

6 . 2 PROPOSED  SYMBOLOGY  STANDARDIZATION 

1.  A right-handed,  orthogonal , .artesian  coordinate  frame, 

i,  is  defined  by  specifying  three  orthogonal  unit 

vectors  z^  along  the  frame  axes. 

2.  A vector  A expressed  in  the  frame  i,  is  designated  by  A1. 

The  components  of  the  A vector  in  the  i frame  are 

designated  by  A , A , A 

i ”i  zi 

3.  A vector  B representing  a motion  of  the  frame  i with 
respect  to  the  frame  j and  expressed  in  the  frame  k is 
designated  by  B^ 

4.  A coordinate  transformation  from  the  frame  i to  the  frame 

j,  having  a common  origin,  is  represented  by  angles  of 
rotation  about  at  most  the  three  i frame  exes  required 
to  bring  the  frame  i axes  to  coincide  with  the  corres- 
ponding frame  j axes. 

For  example  the  following  rotations  may  be  required  to  bring 
the  frame  i axes  into  coincidence  with  the  frame  j axes: 
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a. 


A rotation  about  the  x^  axis  through  an  angle  a. 


b.  A rotation  about  the  y^  axis  (displaced  by  the  previous 
rotation)  through  an  angle  6. 


c . 


A rotation  about  the  z ^ axis  (displaced  by  the  previous 
two  rotations)  through  an  angle  y. 


The  angles  a,  6,  y are  called  the  Euler  angles.  The  positive 
sign  of  the  rotation  angles  is  defined  by  a right-hand  rule. 

An  example  of  a positive  rotation  by  an  angle  a about  the  x^  axis 
is  shown  in  Figures  6-1  and  6-2. 

The  rotation  angles  are  usually  expressed  by  a direction 
cosine  matrix  (9  terms)  or  a quaternion  (4  terms) . The  coordin- 
ate transformation  from  the  frame  i to  the  frame  j expressed 

by  a direction  cosine  matrix  is  designated  by  C?  and  expressed  by  a 

, . i 1 

quaternion  is  designated  by  q^. 

5.  The  major  coordinate  frames  used  in  the  INS  navigation 
computations  are  shown  in  Figures  6-3,  6-4  and  they 
are  listed  in  Table  6-1. 

6.  A general  circle  diagram  representing  the  coordinate 
frames  transformations  used  in  the  navigation  computations 
of  a local- level,  a space-stabilized  and  a strapdown  INS 


is  shown  in  Figure  6-5. 
in  Table  6-2. 


The  transformations  are  also  listed 


A A 
X«  c X* 
*1  AJ 


Figure  6-1.  Rotation  About  X-axis,  Vector  Representation 
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Table  6-1.  Coordinate  Frames  of  Interest  for  SS,  SD,  and  LVWA  Systems  with  SS 
or  LVWA  Navigation 


O-frame 

THE  INERTIAL  REFERENCE  FRAME 

defined  at  moment  of  entry  into  navigation  i.e.  at  t = 0. 

O'— frame 

THE  EARTH  FIXED  FRAME 
coincides  with  0-frame  at  t = 0. 

2-frame 

THE  LOCAL  VERTICAL  NORTH  FRAME 
is  the  frame  of  the  position  and  velocity  outputs. 

2'-frame 

THE  LOCAL  VERTICAL  WANDER  AZIMUTH  FRAME 
coincides  with  stable  element  of  LVWA  platform  and 
generally  with  2-frame  at  t = 0. 

5-frame 

THE  BODY  OR  STRAPDOWN  PLATFORM  FRAME 
defined  by  lateral  and  longitudinal  axes  of  the  vehicle. 

10-frame 

THE  SPACE  STABLE  PLATFORM  FRAME 
coincides  with  stable  element  of  SS  platfo.  m 
(any  orientation). 
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APPENDIX  A 

TRANSFORMATION  OF  COORDINATES 


A. 1 Introduction 

A simple,  compact , unambiguous  notation  describing  trans- 
formation from  one  orthogonal  axis  frame  to  another  is  pre- 
sented in  this  section. 

The  notation  unad  in  describing  the  vectors  and  the  coordin- 
ates transformations  is  based  on  notation  used  by  Britting^^ 

and  the  definition  of  axes  frames  is  based  on  Honeywell  conven- 
or 

tions  used  in  SPN/GEANS  . The  definitions  and  the  notations 
presented  in  this  Appendix  form  a base  for  the  proposed  symbology 
of  frames  and  transformations  described  in  Section  6. 

A . 2 Single  Axis  Rocations 

A coordinate  frame,  i,  is  defined  by  specifying  three 

AAA 

orthogonal  unit  vectors  Y^,  Z^#  which  form  a right  handed 
system,  i.e., 

A A A A A A A A A 

Xi  x Yi  " 7'i'  Yi  x zi  “ xi ' zi  x XA  - Yi 

A A A A A A 

Xi  * Yi  ■ °*  Yi  ’ Zi  ■ °'  Zi  ■ Xi  ■ 0 

where  MxM  denotes  the  vector  product  and  the  scalar  product 
of  two  vectors. 

The  "i"  is  the  short  hand  name  of  the  frame  and  is  one 
or  more  numbers  or  letters  or  soma  combination  thereof.  The 
practice  of  referring  to  the  unit  vectors  defining  a frame  as 

aaAAAAAAAAAA 

i,  j,  k;  u,v,  w;  M,  N,  0}  X,  Y,  Z t etc.  will  not  be  used  be- 
cause there  are  too  many  fremes  and  one  would  soon  run  out 
of  triples  of  letters  for  which  the  sequence  is  obvious.  Further, 
the  existence  of  an  x-axis,  a y-axis,  and  a z-axis  in  each 
frame  is  indispensable  to  the  concept  of  single  axijj  rotations. 
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Consider  two  Cartesian  coordinate  frames  witn  a common 
origin.  Denote  the  first  frame  by  i and  the  second  by  j.  Then 

AAA  A A 

the  unit  vectdrs  defining  the  two  frames  are  X.,  Y.  , Z.  , and  X^,Y., 

a 1 1 1 J J 

Z j . If  one  axis  of  one  frame  coincides  with  the  corresponding 
axis  of  the  other  frame,  i.e.,  if 

A A A A A A 

X-  = X.  cr  Y.  = Y • or  Z . = Z.,  then  the  transformation 
^ 3 J J 

from  one  frame  to  the  other  is  at  most  a single  axis  rotation. 

The  axis  which  is  common  to  the  two  frames  is  the  axis  of  rota- 
tion and  the  angle  between  the  corresponding  non-common  axes 
is  the  angle  of  rotation  or  argument.  The  sign  of  the  angle 
of  rotation  is  positive  if  the  non-common  axes  of  the  first 
("from")  frame  move  in  a clockwise  direction  to  bring  them- 
selves into  coincidence  with  the  corresponding  axes  of  the 
second  ("to")  frame,  looking  in  the  positive  direction  along 
the  common  axis  (right  hand  screw  rule) . 

X-axis  Rotation,  X (a) 

A A 

Tf  X.  = X . , the  transformation  is  an  x-axis  rotation; 

1 J A A A /V 

and  if  the  angle  between  Y-  and  Y-,  and  Z-  and  Z.,  is  a and  if  “ 

J J 

is  positive,  then  transformation  from  i to  j is  written  as  X(a). 
This  is  illustrated  in  Figure  A-l. 

The  equations  relating  the  unit  vectors  of  the  j 
frame  axes  to  the  unit  vectors  of  the  i frame  axes  are: 


A A 


X . 

3 

A 

= x. 

A 

A 

Y . 

= cos  a Y.  + sin  a 

z. 

3 

i 

1 

A 

A 

A 

z . 

3 

= -sin  Y.j  + cos  a 

zi 

or  in  matrix  form 


— 

— — 

— — 

A 

A 

X . 

10  0 

X- 

3 

1 

A 

A 

Y . 

=: 

0 cos  a sin  a 

Y. 

3 

1 

A 

A 

< 

Z - 
1 

0 -sin  a cos  ex 

ZiJ 

J 

— 
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Figure  A-l.  Rotation  About  X-axis 

In  this  particular  case,  the  rotation  from  i to  j,  denotea  by 
ci  It  is  often  helpful  to  represent  a number  of 

single  axis  rotations  in  a signal  flow  graph  form  as  shown 
in  Figure  A-2. 


© — > — ■©  - 0—^-0 

"from"  axis  of  "to" 

frame  rotation  frame 


Figure  A-2 


Rotation  About  X-axis  Flow  Diagram 


The  arrowhead  indicates  the  "to"  frame.  Changing  the 
direction  of  the  arrow  corresponds  to  changing  the  sign  of  the 
argument  or  transposing  the  rotation  matrix. 

Y-axis  Rotation,  Y(g) 

A A 

Simlarly,  if  Yj  = , the  transformation  from  the  j 

frame  to  the  k frame  is  a Y-axis  rotation.  For  a positive 
argument,  $,  this  v;  written  as  Y(6)  and  is  illustrated  in 
Figure  A-3. 

• Y(B)  = 


cosg  0 -sing 

0 1 0 

sing  0 cosg 


86 

p.r‘ 


Figure  A-3.  Rotation  about  Y-axis 
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In  signal  flow  form  we  have  for  Cj  (Figure  A-4) 


* -(  j 


Figure  A-4.  Rotation  About  Y-axis  Flow  Diagram 


2-axis  Rotation,  Z(y) 

A /\ 

Finally,  if  Zk  = Z^,  the  transformation  from  the  k 
frame  to  the  l frame,  C J,  for  a positive  argument,  y,  is 

written  as  Z(y)  and  is  illustrated  in  Figure  A-5. 


Z(Y)  = 


cosy  siny  0 


-smy  cosy 
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Figure  A-5.  Rotation  About  Z-axis 
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ln signal  flow  form  we  have  for  Ck 
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Figure  A-6.  Rotation  about  Z-axis  Flow  Diagram 


A.  3 The  General  Rotation 

If  the  three  single  axis  rotations  are  cascaded,  the 

l 

transformation  from  the  i frame  to  the  l frame,  , may  be 
written  as 


= cf  Ck  cl 
i k j i 


= Z(Y)  y(3)  x(a) 

Note,  that  the  subscripts  cancel  the  superscripts 
from  lower  left  to  upper  right,  leaving  only  the  lower  right 
subscript  ("from")  and  the  upper  left  superscript  ("to"). 
This  latter  notation  appears  in  Britting  . The  vector 
is  designated  by  a small  letter  with  one  or  more  sub- 
scripts, if  required.  The  frame  in  which  a vector  is 
defined  is  denoted  by  a superscript  and  transforming  a 
vector  v from  the  i frame  to  the  l frame  is  expressed  as 


£ J i 

v = C . v 

— i — 
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For  a vector  with  notation  employing  two  subscripts,  such  as  the 
angular  velocity  of  the  ifc^  frame  with  respect  to  the  frame, 

expressed  in  the  k frame  is  expressed  by  to.  . . 

—3,1 

a 

The  transformation,  or  any  other  sequence  of  three 
successive  rotations  wherein  the  axio  of  the  middle  rotation 
is  different  from  the  axes  of  rotation  on  th'  outside,  is  often 
loosely  referred  to  as  the  Eulerian  angle  method  of  specifying 
the  transformation  relating  any  two  Cartesian  coordinate  •‘"Tames 
with  common  origin  — i.e.,  the  Euler  angle  method  permits  the 
specifying  the  transformation  from  one  orthogonal  frame  to 
another  by  stating  the  sign  and  magnitude  of  the  three  angles 
but  implies  a particular  order  of  the  axes  of  the  successive 
rotations,  generally  X,  Y,  Z. 

Several  of  these  general  rotation  matrices  occur  in  the 
mechanization  of  navigation  equations  for  the  various  types  of 
INS.  Two  examples  of  frame  transformations  employed  in  the  navi 
gation  computations  of  the  INS  with  the  local— vertical  wander- 
azimuth  (LVWA)  and  with  the  space-stabilized  (SS)  platform  are 
shown  in  Figures  A -7  and  A-8.  In  either  case,  four  transforma- 
tions are  required  if  attitude  is  computed.  Two  of  the  frames 
indicated,  the  local— vertical  north  frame  and  the  body  frame, 
are  common  to  both  the  LVWA  and  the  SS  systems  (and  also  the 
strapdown  system) . The  number  of  single  axis  rotations  repre- 
sented by  each  of  the  transformations  shown  varies  from  one  to 
four  or  more. 

A prerequisite  to  establishing  a simple,  consistent  set 
of  single  axis  rotations  relating  the  frames  of  interest  ir  to 
define  the  coordinate  axes  of  one  frame  and  then  relate  ti  . 
others  to  it  via  the  appropriate  rotations. 
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For  simplicity,  it  is  desirable  to  avoid  the  introduction  of 
rotations  of  it  or  +tt/2  which  are  added  to  the  nominal  angles 
of  rotation.  This  enables  one  to  state  that  if  all  the  angles 
relating  one  frame  to  another  are  zero,  the  corresponding 
axes  of  both  frames  coincide. 

Since  the  choice  of  the  frame  to  be  defined  as  the  start- 
ing frame  is  arbitrary  4 1 might  as  well  provide  some  useful 
simplification.  The  one  chosen  in  this  discussion  simplifies 
the  initialization  of  a space  stable  system. 

A. 4 General  Circle  Diagrem 

A. 4.1  Introduction 

( 2) 

A general  circle  diagram  , presenting  the  coordinate 

transformations  among  frames  used  in  the  ins  navigational 

computations  is  shown  in  Figure  A- 9 and  the  angles  of  rotation 

are  listed  in  Table  A-l.  Definition  of  the  coordinates’  frames 

(2 ) 

is  based  on  Honeywell  conventions  used  in  SPN/GEANS  and  shown 
in  Figures  A-10  and  A-ll. 

The  general  circle  diagram.  Figure  A-9,  was  obtained  by 
superimposing  the  flow  graphs  of  Figures  A- 7 and  A-8  for  the 
LVWA  and  SS  systems  and  replacing  the  matrices  in  the  rectangular 
boxes  by  appropriate  sequences  of  single  axis  rotations.  Each 
of  the  four  reference  frames  fundamental  to  navigation  and 
attitude  computation  for  the  LVWA  and  SS  systems  is  indicated 
^ud  named  witnin  the  rectangular  box  adjacent  to  the  small 
circle  (node)  designating  the  particular  frame.  The  total  of 
six  fundamental  frames  of  interest  tabulated  in  Table  A-2 
include  not  only  the  SS  and  LVWA  systems  but  also  the  strap- 
down  (SD)  system.  (In  the  latter  case,  it  is  assumed  that  the 
axes  of  the  stra^down  system  coincide  with  the  corresponding 
axes  of  the  body  or  vehicle  frame.) 
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Figure  A-9.  General  Circle  Diagram  for  SS, 
SD,  LVWA  INS  Computations 


Table  A-1.  Definition  of  Angles  in  General  Circle  Diagram 


CUiet 

- 

Earth's  rate  times  time  (from  t = 0) 

poshive  to  East 

X 

- 

Change  in  longitude  (from  t = 0) 

positive  to  East 

L 

- 

Geodetic  latitude 

* 

- 

Heading  (true) 

positive  to  East  from  North 

e 

- 

Pitch  (true) 

positive  for  nose  up 

- 

Roll  (true) 

positive  for  right  wing  down 

a 

- 

Wander  angle 

positive  to  East  from  North 

* L 

- 

LVWA  yaw 

positive  CW  about  down  (same  as  ip} 

V’LI 

- 

LVWA  inner  roll 

(nominally  zero)  (same  a.,y>) 

*L 

- 

LVWA  pitch 

positive  for  nose  up  (same  as  0) 

*LO 

- 

LVWA  outer  roll 

positive  for  right  wing  down  (same  as  v?) 

04 

- 

SS  gimbal  #4 

J positive  for  CW 

°3 

- 

SS  gimbal  #3 

> rotation  of 

e2 

- 

SS  igmbal  #2  (nominally  zero) 

1 inner  gimbs) 

/ 

«i 

- 

SS  gimbal  #1 

w.r.t.  outer  gimbal 

°x 

— 

SS 

f Euler  angles  implicit  in  alignment 

Ou 

— 

SS  > matrix. 

i Assumed  constant  in  this  study.  i 

e 

z 

SS  J 

Euler  angles  for  Strapcown  alignment  matrix  not  shown  since  they  are  not  found  explicitly 


labia  A-2.  Coordinate  Frames  of  Interest  for  SS,  SD,  and  LVWA  Systems  with  SS 
or  LVWA  Naviga'ion 


The  six  coordinate  frames  of  interest  for  any  of  the  six  cases  indicated  are: 


0 -frame 


0'  —frame 


2-frame 


2’-frame 


5-frame 


10— fnme 


THE  INERTIAL  REFERENCE  FRAME 

detinpd  at  moment  of  entry  into  navigation  i.e.  at  t = 0. 


THE  EARTH  FIXED  FRAME 
coincides  with  0-frame  at  t = 0. 


THE  LOCAL  VERTICAL  NORTH  FRAME 
is  the  frame  of  the  position  and  velocity  outputs. 


THE  LOCAL  VERTICAL  WANDER  AZIMUTH  FRAME 
coincides  with  stable  element  of  LVWA  platform  and 
generally  with  2-frame  at  t = 0. 


THE  BODY  OR  STRAPDOWN  PLATFORM  FRAME 
defined  by  lateral  and  longitudinal  axes  of  the  vehicle. 


THE  SPACE  STABLE  PLATFORM  FRAME 
coincides  with  stable  dement  c!  SS  platform. 


Each  individual  node  (result  of  a single  axis  rotation) 
is  specified  by  a .numeral,  starting  with  O(zero)  for  the 
inertial  reference  frame.  Closely  related  frames  may  be  desig- 
nated by  the  same  numeral  with  varying  numbers  of  superscripted 
primes  ( ' ) . 

A.  4. 2 Inertial  Reference  Frame 

The  definition  of  the  inertial  reference  frame  is  illus- 
trated in  Figure A-10.  Under  these  definitions,  the  transforma- 
tions from  the  local  vertical  north  frame  ,2,  to  the 
inertial  frame  at  t = 0 is  simply  Y (L) , where  L is  the  geodetic 
latitude  of  the  INS  navigation  position,  X,  is  the  change  in 
longitude  from  the  initial  longitude. 

2 

A. 4. 3 The  Space  Stable  "Position"  Matrix,  C„,  or  Inertial 
to  Local  Vertical  North  Transformation 

This  transformation  represented  by  the  first  three 
single  axis  rotations  proceeding  counterclockwise  from  the 
inertial  frame,  0,  (Figure  A-9)  is  shown  in  Figure  A-12. 


Figure  A-12.  Inertial-to-Local  Vertical  Transformation 

It  is  written  as 

Cq  = Y ( -L)  Z(A)  Z(wiet) 

= Y (-L)  Z(A+wietJ 


cosL  cos 

A 

cosL  sin 

A 

sinL 

-sin  A 

cos  A 

0 

-sinL  cos 

A 

-sinL  sin 

A 

cosL 
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where  A = A + is  the  change  in  celestial  longitude  from 

t = 0 and  is  given  by 

A •=  tan'1  (|) 

where  X and  Y are  the  equatorial  components  of  inertial 
position. 

The  geodetic  latitude, L is  computed  from 


where  Z is  the  polar  component  of  inertial  position  and  e is 
the  eccentricity  of  the  meridional  ellipse. 


For  output,  the  geodetic  longitude,  A g,  is  computed  from 


' xg°  * A - "let 


where  A^q  is  the  longitude  east  of  Greenwich  at  t = 0. 

In  the  space  stabilized  navigation  computations,  CQ 
is  employed  in  the  transformation  of  inertial  velocity  to  the 
local  vertical  north  (LVN)  frame,  in  the  attitude  computations 
and,  in  aided  systems,  in  the  application  of  velocity  damping 
and  position  reset  calculations. 

2 

A.  4.4  The  Attitude  Matrix,  C,.,  or  Body  to  Local  Vertical 

North  Transformation 

The  transpose  of  this  transformation,  C^,  may  be  repre- 
sented by  the  three  single  axis  rotations  proceeding  from  the 
terminus  of  the  preceding  transformation  (the  LVN  frame  or  2- 
frame)  to  the  body  frame  or  5- frame.  Alternate  methods  of 
representing  the  same  transformations  follow  the  more 
complex  routes  through  the  space  stable  platform  frame  ,0, 
or  the  local  vertical  wander  azimuth  frame,  2,.  A third 
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alternate  representation  of  the  attitude  matrix  is  indicated 
as  embodying  the  (strapdown)  body  to  inertial  frame  trans- 
formation and  the  "position"  matrix.  All  routes  between  two 

nodes  must  yield  the  same  transformation.  In  the  signal  flow 

5 

form  of  Figure  A-9,  C,,,  is  shown  in  Figure  A-13 . 


Figure  A-13.  Body  to  Local  Vertical  Transformations 


It  is  written  as 


C ^ = Z (^  ) Y ( 6 ) X <-<J>) 


The  attitude  angles,  <f> , 9,  ip , correspond  to  the  gimbal 
angles  of  a perfect,  local  geodetic  vertical,  north-slaved, 
three  gimbal  platform,  with  a gimbal  order  of  azimuth  (up) , 
pitch  (right) , roll  (forward) . Changes  in  the  attitude 
angles  are  all  positive  as  the  venicle  goes  from  straight  and 
level  flight  into  a climbing  right  hand  turn.  From  the 
circle  diagram.  Figure  A-9,  all  the  attitude  angles  are  zero 
when  the  vehicle  is  level  and  heading  north.  The  attitude 
matrix  is  given  by 


cj:  = X(iji)  Y (-9)  Z(  — 4>)  = [ a i j ] 


cos9  cos4> 

costy  sin<{>  -simp  sin9  cos<i> 
sin^  sin$  -cosijj  sin9  cos<}> 


-cos9  sintfr  • sin9 

cosy  cosij)  +sini|i  sin9  sin$  | sin4>  cos9 
-sin^  cos<})  +cos<Jj  sin9  sin4>  ! cosip  cos0 


and  the  attitude  angles  are: 


\p  = tan 


-1  ( 23 

\a33 . 


0 = tan 


= tan 


= tan 


-1 


13 


/ _ 2 2 
a23  33 


The  axes  of  rotation  are  permuted  whenever  the  defini- 
tion of  the  inertial  and  hence  the  LVN  frame  is  changed;  how- 
ever, all  attitude  matrices  based  on  the  same  definition  of 
the  attitude  angles  are  related  by  similarity  transformations, 


The  attitude  matrix  must  be  computed  for  a space  stable 
system,  and  may  be  computed  as  part  of  the  high  speed  computa- 
tions for  a north-slaved,  geodetic  vertical  strapdown  sysv.em. 
The  three  gimbal,  horth-slaved , geodetic  vertical  system  pro- 
vides attitude  directly.  A four  gimbal,  LVWA  system — in  a 
high  performance  aircraft,  where  the  inner  roll  angle,  <j>TT, 

JjJL 

is  not  always  zero  must  also  compute  the  attitude  matrix. 

A. 4. 5 The  LVWA  "Direction  Cosine  "Matrix,  C®,  or  LVWA 
Platform  to  Earth  Fixed  Transformation 

The  "direction  cosine"  matrix  for  the  local  vertical 
wander  azimuth  (LVWA)  system  is  the  transformation  from  the 
LVWA  frame,  2',  to  the  earth  fixed  frame,  O',  C®,'.  Of 
course,  any  rotation  is  a direction  cosine  matrix  but  only 
the  one  matrix  (and  most  of  its  elements  individually)  appear 
explicitly  in  most  mechanizations  of  LVWA  systems. 
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In  terms  of  the  nomenclature  of  Figure  A-9,  the  LVWA 

O' 

platform  to  the  earth  fixed  frame  transformation,  C21 
is  shown  in  signal  flow  form  in  Figure  A-14. 
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Figure  A-14.  LVWA  to  Earth  Fixc-J  Frame  Transformation 
It  is  written  as: 


Z(-A) 

Y(L) 

X (a) 

A 

■ IAi:’ 

cosA  cosL  1 

| 

cosA 

sinL 

sina 

-sinA  cosa 

1 

-cosA 

sinL  cosa 

-sinA 

sina 

sinA  cosL  ( 

sinA 

sinL 

sina 

+cosA  cosa 

I 

| -sinA 

sinL  cosa 

+cosA 

sina 

sinL  | 

-cosL 

sina 

| cosL 

cosa 

The  elements  of  the  third  row  of  C^,,  are  used  in 


,0* 

2- 


the  computations  of  angular  velocities  and  gravity.  In  addi- 

,0' 

'2' 

and  wander  angle  computations  viz: 


tion  the  first  column  of  C” , also  enters  into  the  position 


L = tan 


-1/ 


31 


\=  tan 


-1 


31 


n 2 , . 2 

A11  + A21 


. 2 . 2 
A32  A33 


V tan 


a = tan 


\A11/  9° 

-1  ( ~A32  \ 

A-  1 


/ 


Note  that  longitude,  A , and  wander  angle,  a,  are  indeterminate 

y 

at  the  poles  (L  = +tt/2)  . Some  special  logic  will  be  required 
at  this  point  so  that  tan  ^ (0/0)  will  return  the  previous  value 
of  Ag  or  a. 


Kfcl 
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A. 4. 6 The  Space  Stable  Gimbal  Angle  Matrix,  or  Bod^ 

to  Space  Stable  Platform  Transforma_  on 


Four  single  axis  rotations  are  normally  required  for 
this  transformation.  The  trivial,  in  this  case,  identity 
matrix,  I,  relating  the  body  frame,  5,  to  the  platform  case 
frame,  6,  is  normally  reserved  for  misalignments  of  the 
case  with  respect  to  the  vehicle.  In  a non-trivial  case 
Cg°  could  accommodate  an  orientation  of  the  outer  gimbal 
along  the  yaw  axis  rather  than  the  roll  axis  of  the  vehicle. 


The  signal  flow  form  of  is  shown  in  Figure  A-15. 


Figure  A-15.  Body  to  Space  Stable  Frame  Transformation 


Calling  0.  + tt/4  ^ 6' 


Cf.  is  written  as 


C5  = Z(6p  Y(62)  X(03)  Z ( 0 4 ) I 


For  reasonable  computational  efficiency  and  memory 
utilization,  C^°  is  subdivided  into  two  two  axis  rotations 


4°  - 4°  4 


where 


CjJw  = Z(6|)  Y(62) 
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mm 


cos0j  cos02 


-sin8|  cos02 


sin0. 


sin0|  -cos0j_sin02 


cos0| 


sin0^  sin02 


COS0, 


and 


c®  » x<63)  Z(ea> 


r 


cos  0 , 


-cos03  sinO^ 


sin03  sinO^ 


sin0.  0 


cosO^  cos04  sin0. 


-sin03  cos04  cos0- 


During  navigation,  is  employed  solely  for  attitude  com- 
putation. 


A.  4. 7 The  LVWA  Gimbal  Angle  Matrix,  C ^ or  Body  to 
LVWA  Platform  Transformation 

This  transformation  performs  the  same  function  in  a four 
gimbal,  LVWA  platform  mechanization  as  does  in  a SS  plat- 
form mechanization. 

However,  assuming  that  the  gimbal  order  for  the  LVWA 
platform  is  azimuth,  inner  roll,  pitch,  outer  roll,  the  order 
of  the  single  axis  rotations  is  different  from  that  specified 
for  the  particular  SS  system  (GEANS)  shown. 
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The  signal  flow  form  is  shown  in  Figure  A-16 : 
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Figure  A-16.  Body  to  LVWA  Platform  Frame  Transformations 

2 ' 

is  written  as: 

C“’=  X(*L)  Z(-*LI)  y(-0L)  Z(-*t0) 

For  the  same  reasons  as  before,  C^'  is  subdivided  into  two 
two  axis  rotations 


2 ' 2 1 V' 

5 3" 


where  C^,,  = X(t^)  z(-^LJ) 


cos^li 

-sin^ 

0 

cos\pT  sin^.  T 

u ijl 

COS^L  CCS<{)LI 

sinifi 

-sinij>T  sin4>TT 

Li  LiL 

•■sin^L  cos4>li 

COSlf'. 

"=  y(-eL)  z(- 

'♦lo* 

cosOT  COS(J>TO 
Li  LiU 

-cos0T  sin<J>T„ 

Li  LiU 

sin0L 

sin<^L0 

oos^lq 

0 

-sineL  cos4>l0 

sin0L  sin$L0 

COS0T 

xj 

1 J 
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It  should  be  noted  that  none  of  the  local  vertical  sys- 
tems surveyed  (and  a few  contained  four  gimbal  platforms)  com- 
puted attitude  at  all.  The  attitude  was  obtained  directly 
from  the  readout  of  the  gimbal  resolvers.  The  assumptions 
imp.V.cit  in  this  are  <j>LI  = 0,  therefore  (3")  = (3'),  then 
(4')  = (4)  and  (3')  = (3)  and  hence  <j>T<_  = <j>  and  0T  = 9. 

IjU  Jj 

Finally,  t|>L  + a = <Jj  . 

A . 4 . 8 Other  Transformations 

Several  other  transformations  occur  in  one  or  more 

mechanizations.  Two  are  single  axis  rotations;  the  wander 
2 

angle  matrix,  C_,  = X(a)  and  the  inertial  to  earth  fixed 
0 • 

rotation  C.  - Z(a>.  t)  ; hence  they  need  no  further  explana- 
0 

tion.  A third,  C1Q,  is  shown  in  the  circle  diagram  as  an 
Euler  angle  matrix 

C10  “ Z(0Z)  Y(6Y)  X(0X) 

However,  this  definition,  i.e.,  of  the  rotations  is  arbitrary 
and,  for  the  purposes  of  this  study,  is  constant. 

A.  4. 9 A Computational  Simplification 

An  alternate  expression  for  the  LVWA  gimbal  angle  matrix, 

2 ' 

Cg, , is  from  Figure  A- 9. 

C*'  = X (-a)  X(<!0  Y (-0 ) Z(-<l>) 

D 

= X ( ^-a)  Y (-9)  Z(-4>) 

2 ' 

If  the  "attitude-like"  angles  are  extracted  from  Cj.  as  pre- 
viously indicated,  pitch  and  roll,  0 and  4>,  will  be  correct 
and  true  heading  will  be  obtained  simply  by  adding  the  wander 
angle,  a,  to  the  "heading-like"  angle,  V - a. 
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The  above  simplification  is  used  ir  the  attitude  compu- 
tations for  all  three  types  of  INS  employing  LVWA  computa- 
tional frame  and  for  the  LVWA  INS  employing  SS  computational 
frame.  The  computational  flow  diagrams  are  shown  in  Section  2, 


Appendix  B 

Derivation  of  Fundamental 
Equation  of  Inertial  Navigation 


Preliminaries  (in  Euclidean  3 space) 

Angular  Velocity  (as  Vector)  is  denoted  by  ui^,  where  a,b,  and  c, 
are  the  designators  for  three  different  Cartesian  coordinate  frames. 
t£ka  is  read  "the  angu  ir  velocity  of  the  a frame  with  respect  to  the 
b-frame  expressed  in  c-frame  coordinates." 

Transformation  of  a Vector 

Angular  velocity  or  any  other  vector  quantity  may  be  expressed 
in  terms  of  its  components  in  any  other  Cartesian  frame  by  pre- 
multiplying the  vector  by  the  rotation  matrix  relating  the  frame 
in  which  the  vector  is  expressed  to  the  frame  in  which  it  is  de- 
sired to  express  it. 

Using  the  example  of  the  angular  velocity  vector, 

previously  defined,  it  might  desired  to  express  this  vector  in  terms 

of  the  coordinates  of  the  a-frame  rather  than  the  c-frame.  If  the 

rotation  from  the  c-frame  to  the  a-frame,  C , is  known,  then 

c 

a na  c 
ov , = C w. 

— ba  c— ba 


The  Cross  Product  Operator 

In  an  Euclidean  3 space,  there  is  a one-to-one  correspondence 
between  the  three  elements  of  a vector  and  the  nor.-zero  elements 
of  a three  by  three,  skew  symmetric  matrix  (isomorphism),  i.e. 


0 -V  V 
z y 

1 0 -V 


v I -v  v 
c z j u y x 


In  case  v is  an  angular  velocity/  w,  the  corresponding  skew  symmetric 
matrix  is  denoted  by  ft  o.g. 


ft 


When  the  ft  precedes  a vector/ 


c 

ba 

say. 


r, 


then 


ftr  ■ wxr 


Or  introducing  appropriate  subscripts  and  superscripts 


Therefore  ft  is  called  the  "cross-product  operator".  Transforming 
the  cross  product  operator  involves  premultiplying  ft  by  a rotation 
matrix  and  post  multiplying  by  the  transpose  of  the  rotation  matrix. 

For  the  vector  form  we  had  (as  before) 


a 

^ba 


ra  c 
Cc-ba 


For  the  corresponding  skew  symmetric  form  we  have 


°Sa  * ce  nba  Ca 


Time  Derivative  of  a Rotation  Matrix 

The  time  rate  of  change  of  the  elements  of  a rotation  matrix 
in  terms  of  the  angular  rates  expressed  in  either  of  the  terminal 
frames  is  frequently  required.  For  example,  given  the  rotation 
matrix,  C®,  what  is  C®,  where  the  superscript  dot  denotes  ordinary 
differentiation  with  respect  to  time?  As  may  be  demonstrated  in 
a number  of  ways 


Cc  na= 


n-? 


Derivation 


It  is  now  intended  to  derive  the  vector  expressions  for  the 
derivative  of  the  velocity  of  the  platform  frame  with  respect  to 
the  earth  fixed  frame  expressed  in  platform  frame  coordinates. 

First,  let  r1  be  the  position  vector  from  the  center  of  the 
earth  to  the  vehicle  in  Cartesian  inertial  frame  (i)  coordinates. 
The  same  vector  expressed  in  terms  of  the  coordinates  of  an 
earth-fixed,  earth  centered  (e)  frame  is  re. 


where 


r1  = C1^ 
— e— 


(1) 


and  the  angular  velocity  of  the  e-frame  relative  to  the  i frame  is 
a constant,  ui^e  Differentiating  (1)  with  respect  to  time  we 
have 


but 


Let 


C^re  + CXre 
e—  e— 


r = 

ii  - 

I1  “ Ciie  + <&* 


cl 

le  e 


v = 


Care 

e— 


(2) 

(3) 

(4) 

(5) 


and  substituting (1) into (4) 


r1  = v1  + ft*  r1 
- — le— 


(6) 


Differentiating  (6)  with  respect  to  time  we  have 


-1  = -1  + ^ie-1  + fiie^ 


(7) 


But  noting  that  She=0,  since  uie  is  a constant,  and  substituting 
(6)  into  (7)  we  have. 


r1  = v1  + v1  + nl  (1*  r1 
— — re-  ie  le- 


ts) 
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where  r1  is  the  total  inertial  acceleration  expressed  in  inertial 
coordinates.  In  the  computational  (C)  frame  (8)  becomes 


ci— 1 - ci^  + (C^v1)  + (Cjflje<£)  (cV^ecJ)c^ 

C?vx  = vc  + ft?„vc 


iC-.i  « i \ ,^c~i  _c  i 


C^r1  = cjcf1  + Gc)  = f C + Gc 


where  f1  is  the  specific  force  and  G1  is  mass  attraction  in  the 
inertial  frame.  Substituting  (10)  and  (11)  into  (9). 


fc  + Gc  = vc  + ft?  vc  + ft?  vc  + ft?  ft?  rc 
- — — ic-  le-  xe  le- 


c . _c  _c  — C c 

g AG  - ft . ft.  r 

-2-  = — i e i p— 


VC  = fc  + gC  - (ft°c  + ft?jvc 


ft?  = ft?  + ft?0 

ic  ie  ec 


vc  = fc  + 2C  ~ (ft^r  + 2ft?  )vc 
— ec  le  — 


APPENDIX  C 

THE  GEODETIC,  THE  ASTRONOMIC  AND 
THE  GEOCENTRIC  LATITUDES 

The  local  mean  sea  level  of  the  earth  is  represented 
by  a surface  of  a geoid.  The  average  surface  of  geoid  is 
represented  by  a spheroid  (an  ellipsoid  of  revolution  about 
the  minor,  polar,  axis  of  the  ellipse) . 

The  geodetic,  the  astronomic  and  the  geocentric  lati- 
tudes definition  are  shown  in  Figure  C-l.  The  latitudes  are 
defined  by  the  angles  in  the  local  meridian  plane.  The  angles 
are  measured  from  the  line  in  the  equatorial  plane,  determined 
by  an  intersection  of  the  local  meridian  plane  with  the  equa- 
tional  plane. 

The  geodetic  latitude  at  the  point  P is  defined  by  the 
angle  between  the  line  in  the  equatorial  plane  and  the 
normal  to  the  surface  of  the  spheroid. 

The  astronomic  latitude  of  the  point  P is  defined  by 
the  angle  La  between  the  line  in  the  equatorial  plane  and  the 
normal  to  the  surface  of  the  geoid. 

The  geocentric  latitude  of  the  point  P is  defined  by 
the  angle  LQ  between  the  line  in  the  equatorial  plane  and  the 
line  from  the  earth  center  to  P. 

The  difference  between  the  geodetic  latitude  and  the 
atronomic  latitude  is  caused  by  the  gravity  anomalies  and 
it  is  called  deflection  of  the  vertical  in  the  meridian  plane. 
The  deflection  of  the  vertical  remains  in  large  portion  of  the 
earth  below  10  arc  sec,  but  1 arc  min  deflections  are  also 
encountered. 


C-l 


The  difference  between  the  geodetic  latitude;  and  the 
geocentric  latitude  is  caused  by  the  earth  oblateness.  The 
latitude  difference  is  also  effected  by  the  altitude  h of  the 

noint  P.  The  difference  between  the  geodetic  latitude,  L , 

V: 

and  the  geocentric  latitude,  LQ,  is  < ven  by: 

Lg  - Lo  * f (1  - !>  sin  2 Lg 

where  f = 1/298  is  the  earth  flattening,  R = 6371000  meters 
is  the  radius  of  the  earth  with  equal  volume  and  h is  the 
altitude  of  point  P in  meters. 

At  latitude  45°,  near  the  earth  surface,  the  difference 
between  the  geodetic  and  the  geocentric  latitudes  is  approxi- 
mately 1.6  arc  min  and  the  altitude  change  of  30,000  ft  results 
in  1 arc  sec  latitude  difference. 


C-2 
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APPENDIX  D 

IMPROVING  THE  ACCURACY  OF  THE  "BASELINE"  LVWA  NAVIGATION  ALGORITHM 


This  appendix  is  addressed  to  one  of  the  several  aspects 
of  the  problem,  namely,  the  more  accurate  numerical  integration 
of  the  differential  equations  involved  in  pure  inertial  navigation. 

The  prime  inputs  to  the  navigation  algorithm, for  the  present 
purpose,  are  the  integrals  of  the  components  of  the  specific  force 
in  the  computational  frame,  over  the  navigation  computation  cycle. 
Together  with  the  initial  conditions,  this  is  all  the  information 
required  for  pure  inertial  navigation. 

The  first  job  of  the  navigation  algorithm,  for  an  earth- 
relative  computational  (c)  frame,  is  the  integration  of  the 
"fundamental  equation  of  inertial  navigation",  the  v equation 
from  Appendix  B,  over  a navigation  computation  cycle,  At.  The 
V equation  is  repeated  below: 


vc  = fc  + gc  - (Qc  + 2 a?  ) VC 

— — -2-  i ^ — 


(D-l) 


All  the  symbols  in  the  above  are  defined  in  Appendix  B and  Section 
2.4.1  of  this  volume.  Integrating  this  equation  from  some  time,  t, 
tc  (t  -s-  At)  , we  have 


t+At 


t+At 


v (x)  dx  = 


= / fC(T)dT  + j £° 


t+At 

-J  [*’> 


+2^ie^-C*T)dT 


(D-2) 


Since  the  object  of  the  integration  is  to  obtain  vc  (t  + At) . 
Equation  (D-2)  is  rearranged  as  shown  below: 


t+At 


vu'(t+  t)  « vc(t)  + Av“(UAt)  +1  £w  (r)dt 


! 


t+At 


t 

t+At 


fn 


° (t) vC(t)dr 


-if  nje(t)vc 


(t)  dt 


(D-3) 


t+At 


where  Avc  (t  + At) 


•'t 


) dx 


Note  that  Avc  (t  + At)  is  the  output  of  an  ideal  (integrating) 
accelerometer  triad  in  the  computational  frame  at  time  (t  + At) . 

The  underlined  portions  of  Equation  (D-3)  will  not  change 
as  the  algorithm  is  upgraded;  the  potential  accuracy  improveii  2nts 
lie  in  obtaining  better  approximations  to  the  three  remaining 
integrals  on  the  right  hand  side  of  Equation  (D-3). 

Before  considering  the  higher  order  algorithm  we  note  that 
manner  in  which  the  "baseline"  algorithm  computes  the  three  integrals 
on  the  right  hand  side,  viz: 


2C(T)dt 


* 2C(t)At 

Base 


(D-4) 


which  assumes  £C(t) 


0 


D-2 


t+At 

f [°eo('T)  * 

4 


2«ie(Ti 


t+At 

v(x)dx  =|  3C\_x)vc(xidx 


■I 


(D-9) 


Expanding  the  integrands  in  Eq.  (D-3)  in  Taylor's  series  about  t, 
we  have 

t+At 

:)dx  (D-10) 


SvC( t+At) 


if  £°  ( T ) 

•'t 


t+At 
r 


^ 2.C  (t)  + C[C(t)  (T-t)  + gC  (t ) - + . . . 


dr 


2 3 

c,....  j •c,,.  At  , ..c,,.  At  , 
= g ( t ) At  + 2 (t)  + £ (t)  -g-  + 


Similarly 


-6v  (t+At) 


t+At 

, 1 


fl**'  A I fiC(T)VC(Tjdt 


(D-ll) 


whera  iic(x)  = fic(t)  + flc(t)  (x-t)  +flc(t)---j^-  + 


and  vc(x)  = vc(t)  + vC(t)(x-t)  + vc ( t) 


Then  the  integrand,  fic(x)vc(x),  is  given  by 


S2C  (x)  vc  (x)  = fiC(t)vC(t) 


(D~12 ) 
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The  assumptions  in  the  second  order  algorithm  are 


vc(t),  gc  (t) , jjc(t)  = 0. 


Subject  to  the  above  assumptions,  one  may  regroup  the  terms  in 
gc(t)  and  2°(t)  viz: 


6vc (t+At) 


2nd 


2° ( t) A t + 2°(t) 


(D-15) 


= |^2.C(t)  + 2C(t)  At 

- ac(t+¥)  4t 


Therefore,  if  we  can  obtain  an  estimate  of  the  extrapolated  value 
of  2°  at  the  midpoint  point  of  the  next  computation  cycle,  we  have 
effectively  incorporated  its  derivative  at  the  present  time.  The 
mechanism  for  computing  the  extrapolated  value  of  2°/  simply  con- 
sists of  noting  that 


where  L is  geodetic  latitude 

a is  wander  angle 
h is  altitude 


as  may  be  seen  from  any  of  Equations  (2-39)  (2-62)  or  (2-78)  in 
Sections  2.4. 1.2, 2.4.3  or  2.4.4  of  this  volume. 


■sr*" 


The  required  functions  of  L and  a are  contained  in  the  extrap- 
olated dcm  while  h may  be  extrapolated  directly.  Therefore  an 
estimate  of  2C(t+7r)  maybe  obtained  at  t for  use  at  (t+At) . 

c 

Now  we  attempt  to  upgrade  the  6v  (t+At) 
replacing  (.t)  vc  (t)  At  by  Qc  (t+^)  vC  (t+~-)  At 


computation  by 


where  Qc( t+4p)  = ftc(t)  + 6c(t)  ^ 


and  vc(t+4^-)  = vc(t)  + vc(t)  ^ 


if  vC(t),  a1' (t)  = 0 


Then  QC(t+4£)  vc(t+4£)  At  = ( t)  P.C  ( t)^|  | vc  ( t)  + 


: c / . , , • c , A t 

• V (t)  + V (t)-j-  I 


(D-17) 

At 


= QC ( t) vC ( t) At 


^C(t)vC(t)  + flC(t)vC(t)] 

[3ac / . v • c , , . At3 
2^  ( t ) v (t)J  -g— 


At 

2 


Hence  using  the  mid-computation  cycle  values  of  angular  velocity 
and  velocity  not  only  gives  the  correct  second  terms  for  (uixv)At 
but  also  3/4's  of  one  of  the  third  order  terms  of  Equation  (D-13). 

c At 

The  method  of  obtaining  the  estimates  of  v ( tH — ~— ) and 

c A t c 

fi  (t+-j-)  is  straightforward.  Before  v (t)  is  updated  at  time  t, 

from  time  (t-At) , the  old  value  is  stored  and  the  extrapolated 

value  is  estimated  as 


v (t+^)  i fit) 


+ £ v 


c(t)  - vC (t-At) 


At 


(D-18) 


= § j^3vC(t)  - vC(t-At)j 
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There  is,  of  course,  a lag  of  in  the  computed  derivative  of 
velocity  but  it  is  better  than  no  derivative  at  all  and  besides 
it  is  vet/  inexpensive  computationally. 

c At 

The  estimated  angular  velocity,  w , at  time  ( tn — g-)  may  be 
written  as 

ftc(t+^)  = fvc(t+^),  L ( t+4p)  , a(t+^),  h(t+^)j  (D-19) 

c At  c 

That  is,  to  tt+-=-)  is  a function  of  the  same  variables  as  2 (t+At) 

^ c A t 

plus  the  linear  velocity  v (t+-g-)  , which  latter  we  have  just 
estimated. 

0 At 

The  extrapolated  dcm,  (^(tt-^-),  which  contains  the  appro- 
priate functions  of  L and  a,  is  obtained  as  an  almost  painless 
byproduct  of  the  update  of  the  dcm  from  time  (t-At)  to  time  t 
(the  second  integration) . The  dcm  update,  per  se,  which  is 

assumed  to  be  second  or  higher  order,  constructs  an  additive 

0 

"update"  matrix  6C  (t,t-At)  which  is  stored,  then  added  to  the 
e c 

"old"  dcm,  Cc(t-At)  as  shown  below 


Cc(t)  = C® (t-At)  + AC® (t, t-At) 


(D-20) 


The  extrapolated  dcm  is  given  by 

C®(t+^>  = C®(t)  + - 6C®(t,t-At) 

The  "update"  matrix  itself  is  of  the  form 


where  (t-^~)  is  the  skew  symmetric  form  of  a>u  (t-^£)  or  Pc (t-^) , 
the  angular  velocity  of  the  computational  frame  with  respect  to  the 
earth  fixed  frame,  expressed  in  the  computational  frame,  and  com- 
puted at  midpoint  of  the  computation  cycle. 


(D-21) 


6C®(t,t-At)  = C®(t-At) j flgC( t-^)At  +[^eC(t~)]  +J  (0-22) 


At» 
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c At 

The  angular  velocity,  ft  (t — =-)  , is  a function  of  the  same  vari- 
c At  ec  * 

ables  as  ft  (t-y-)  i.e., 


»ec(t-¥} 


i 

v 


c(t4£) 


L(t-^) 


a(t-^) 


h (t-4^) 


] 


(D-23) 


Rather  than  use  the  extrapolated  value  of  vc  from  the  previous 
computation  cycle,  it  is  more  accurate  and  almost  as  simple  to 
use  an  interpolated  value  of  v from  the  present  co.routation 
cycle . 

Define  vc(t-y-)  by 

vC ( t-y)  ^ | [vc(t)  + vc(t-At)]  (D-24) 

For  the  remaining  three  variables  (or  functions  thereof)  it  is 
sufficient  to  use  the  extrapolated  values  from  the  previous 
computation  cycle. 

The  other  part  of  ftc(t-^),  ft®e(t-^),  is  strictly  a func- 
tion of  L,  a,  and  i.e., 

ft^e(t--y)  ■ £ L (t-A^)  , a(t-y^  (D-25) 

Here,  F4  is  obtained  directly  from  the  elements  of  the  extrapolated 
dcm  from  the  previous  computation  cycle. 

Putting  all  the  foregoing  together  in  the  appropriate  order, 
along  with  suitable  initialization,  and  vertical  damping  (see 
Appendix  F) , and  we  have  the  "Upgraded  LVWA  Navigation  Algorithm* 
(see  Section  2.4  of  this  volume)  - which  might  approach  the 
accuracy  of  a vastly  simpler  space  stable  navigation  algorithm. 
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APPENDIX  E 

APPROXIMATING  THE  MID  COMPUTATION  CYCLE  TRANSFORMATION 

In  the  strapdown  computations  the  mid-computation  cycle  transfor- 

c 

mation  from  the  body  frame  to  the  computational  frame,  C.  , is 

• , * i °N-l/2 

approximated  by 

Cc  = i (cc  + cC  I 

bN-l/2  2 \ bN  bN-l/ 

A direction  cosine  matrix  or  quaternion  update  is  used  to  update 
c c . 

C.  to  C,  . Consider  the  d.c.m.  update.  Then 

Vl  bN 

Cp  = Cp  CO) 
bN  bN-l 

where  C(0)  = I + r sin  0 + R2  (1-cos  0) 


and  R =j 


0 -c  b 

c 0 -a 

-b  a 0 


where  a,b,c  are  the  direction 
cosines  of  the  axis  of  rotation 


Hence  Cp  = i c£ 

w-1/2  Z °N-J 


(I  + I + R sin0  + (l-cos0)] 


= CC  + CC 

Vl  Vl 


,,  sin©  , „2 

/l-COS0\ 

R — + R 

\ 2 ) 

The  exact  expression  for  Cp  , assuming  0 is  a constant,  is  given 

by  N-X/2 


3N-l/2 


I + R sin|| -j  + R2  ^1-cos^ 


/ r 

/ / 

R sin 

r)  + R l 

1-cos  1: 

m 

E-l 


The  error  is  the  approximation  is 


Cc  - cc  = Cc 

bN-l/2  bN-l/2  b 


^ {« [%*■  - ^ (I)] 

+ R2[(k£|3i)-(1(:os  (|))]j 


Expanding  sin  0,  cos  9,  sin|jj  , cos  to  the  third  power  in  9 

e3  a2 

sin  0 = 0-  ~p~,  cos  0 = 1-  -r- 
6 2 


’0\ 0 0' 


SinV?]  2 “ 48'  COS' 


1 - 


■(!)--  T 

Inserting  these  expressions  and  simplifying  gives 


5°  - Cc  = ^ (_ r ii  . r2  £ 

bN-l/2  bN-l/2  bN-l  L 16  8 


If  rotation  is  entirely  about  the  roll  (longitudinal)  axis,  then  the 
direction  cosines  of  the  axis  of  rotation  are  {a,b,c}  = { 001} 


and  R = 

’ 0 1 o' 
-10  0 

, r2  = 

-10  0 

0-10 

0 0 0 

1 

o 

o 

o 

1 

3 

The  -R0  /16  term  will  produce  a very  small  rotational  error  in  the 
normal  and  lateral  components  of  the  integral  of  specific  force 
which  would  cancel  out  at  the  end  of  the  turn. 

2 2 

The  R 0/8  will  produce  a scale  factor  error  in  both  the 
normal  and  lateral  components  which  will  be  rectified  and  hence,  will 
not  cancel  out  at  the  completion  of  the  turn.  The  nature  of  this 
error  is  such  that  it  does  not  propagate  directly  into  an  attitude 
error,  but  since  it  introduces  a scale  factor  error  into  the  incre- 
mental velocity  while  the  attitude  is  changing,  it  will  integrate  into 
velocity  and  hence  position  error  and  into  the  computed  vehicle  rate 
where  it  will  ultimately  produce  an  attitude  error. 


E-2 


The  magnitude  of  the  lateral  velocity  error  introduced  during 
the  roll-up  and  roll  down  portion  of  a 1/2-g  horizontal  turn,  when 
the  constant  roll  rate  is  180  degrees  per  second  and  the  strap- 
down  computation  cycle,  .it,  is  1/128  of  a second  is  computed  below. 

The  scale  factor  error,  is 

or 


• 2 2 2 -7  ^ 

♦ At*  _ n x(2  ')  _ ^2  v ~-7  _ 


'SF  8 


= n x 2 =75  ppm 


The  maximum  roll  angle,  <J>  , is 


= tan  x 1/2  ^ 26.656° 


The  roll  up  time,  t , is 


t,  = -x  = 0.1475  sec 
u q> 

The  lateral  velocity  error  at  the  completion  of  the  term  is  the 
scale  factor  error  times  the  area  under  the  lateral  acceleration 


curve 


eVleSF  eSF  ( 2 gmax  2tu) 


-5  - 3 

= 7.5x10  xl6x.l475  = 0.177x10  fps 

This  is  a significant  error.  It  may  be  eliminated  in  one  of  two 
ways.  The  simplest  is  to  alternate  the  "attitude"  matrix  update 
with  the  AV  transformation  so  that  no  interpolation  is  required, 
which  is  a practical  solution  adopted  by  some  strapdown  systems. 

The  second,  which  is  applicable  to  the  present  case  i.e.  PROFGEN/ 
NUMSIM,  consists  of  performing  a second  update  of  the  "attitude" 
matrix  using  half  the  incremental  angles  and  a second  or  higher 
order  update. 

The  efficient  incorporation  of  these  operations  into  the  d.c.m. 
and  quaternion  updates  should  be  investigated  during  any  follow-on 
efforts. 


E-3 


VOLUME  II 


APPENDIX  F 

VERTICAL  DAMPING  FOR  THE  "UPGRADED"  ALGORITHM 

The  assumption  invoked  throughout  the  algorithm  development  has 
been  (and  still  is)  that  information  is  available  at  the  end  of  a 
computation  cycle  and  that  outputs  are  to  be  provided  appropriate 
to  the  end  of  the  computation  cycle. 

This  implies  that  the  computer  time  required  to  update  the  out- 
puts (which  is  in  the  range  of  a few  milliseconds  to  tens  of  milli- 
seconds) is  a negligible  delay.  For  some  purposes  this  delay  may  not 
be  acceptable  and  specific  steps  may  have  to  be  taken  to  extrapolate 
INS  output  parameters  ahead  to  the  time  of  their  intended  use. 

At  any  rate,  there  is  a premium  to  be  placed  on  minimizing  the 
delay  between  accepting  input  data  and  outputing  the  updated  navigation 
and  attitude  data,  particularly  the  rapidly  changing  outputs,  such 
as  velocity.  Therefore,  the  data  required  fcr  velocity  updating, 
including  the  vertical  damping,  but  excepting  the  incremental 
velocity,  are  all  computed  at  the  end  of  the  previous  computation 
cycle  for  use  in  the  early  portions  of  the  present  update  cycle. 

The  rationale  for  the  improved  accuracy  navigation  algorithm 
was  outlined  in  Appendix  D of  this  volume,  while  the  algorithm  proper 
was  presented  in  Section  2.4  of  this  volume.  The  continuous  form 
of  the  damped  vertical  channel  was  shown  in  Section  2.4.2  of  this 
volume . 

The  only  additional  coding  specifically  required  to  upgrade  the 
vertical  damping  mechanization  is  the  extrapolation  of  the  reference 
altitude  to  mid-computation  cycle.  (The  system  computed  altitude 
was  already  extrapolated  to  mid-computation  cycle  for  the  "gravity" 
computation) . 


F-l 


The  upgraded  vertical  channel  computations  are  shown  in 
Figure  F-l  in  the  detailed  computation  flow  diagram.  Below 
the  dashed  line  are  the  (linearized)  undamped  vertical  damping 
calculations  proper.  In  Figure  F-l,  the  inputs  to  the  "unit  delay" 
boxes,  were  computed  during  the  previous  cycle,  and  become  the 
outputs  of  the  boxes  during  the  present  cycle  (after  which  the 
inputs  are  updated  again) . It  is  obvious  from  the  figure  that 
a very  modest  number  of  arithmetic  (consisting  of  summation  and 
scaling)  operations  are  required  to  update  the  velocity  - once 
the  incremental  velocity  is  available. 
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